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" 28386e2955SPeter Maydell 29e69954b9Spbrook //#define DEBUG_GIC 30e69954b9Spbrook 31e69954b9Spbrook #ifdef DEBUG_GIC 32001faf32SBlue Swirl #define DPRINTF(fmt, ...) \ 335eb98401SPeter A. G. Crosthwaite do { fprintf(stderr, "arm_gic: " fmt , ## __VA_ARGS__); } while (0) 34e69954b9Spbrook #else 35001faf32SBlue Swirl #define DPRINTF(fmt, ...) do {} while(0) 36e69954b9Spbrook #endif 37e69954b9Spbrook 383355c360SAlistair Francis static const uint8_t gic_id_11mpcore[] = { 393355c360SAlistair Francis 0x00, 0x00, 0x00, 0x00, 0x90, 0x13, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1 403355c360SAlistair Francis }; 413355c360SAlistair Francis 423355c360SAlistair Francis static const uint8_t gic_id_gicv1[] = { 433355c360SAlistair Francis 0x04, 0x00, 0x00, 0x00, 0x90, 0xb3, 0x1b, 0x00, 0x0d, 0xf0, 0x05, 0xb1 443355c360SAlistair Francis }; 453355c360SAlistair Francis 463355c360SAlistair Francis static const uint8_t gic_id_gicv2[] = { 473355c360SAlistair Francis 0x04, 0x00, 0x00, 0x00, 0x90, 0xb4, 0x2b, 0x00, 0x0d, 0xf0, 0x05, 0xb1 482a29ddeeSPeter Maydell }; 492a29ddeeSPeter Maydell 50fae15286SPeter Maydell static inline int gic_get_current_cpu(GICState *s) 51926c4affSPeter Maydell { 52926c4affSPeter Maydell if (s->num_cpu > 1) { 534917cf44SAndreas Färber return current_cpu->cpu_index; 54926c4affSPeter Maydell } 55926c4affSPeter Maydell return 0; 56926c4affSPeter Maydell } 57926c4affSPeter Maydell 58c27a5ba9SFabian Aggeler /* Return true if this GIC config has interrupt groups, which is 59c27a5ba9SFabian Aggeler * true if we're a GICv2, or a GICv1 with the security extensions. 60c27a5ba9SFabian Aggeler */ 61c27a5ba9SFabian Aggeler static inline bool gic_has_groups(GICState *s) 62c27a5ba9SFabian Aggeler { 63c27a5ba9SFabian Aggeler return s->revision == 2 || s->security_extn; 64c27a5ba9SFabian Aggeler } 65c27a5ba9SFabian Aggeler 66e69954b9Spbrook /* TODO: Many places that call this routine could be optimized. */ 67e69954b9Spbrook /* Update interrupt status after enabled or pending bits have been changed. */ 68fae15286SPeter Maydell void gic_update(GICState *s) 69e69954b9Spbrook { 70e69954b9Spbrook int best_irq; 71e69954b9Spbrook int best_prio; 72e69954b9Spbrook int irq; 73dadbb58fSPeter Maydell int irq_level, fiq_level; 749ee6e8bbSpbrook int cpu; 759ee6e8bbSpbrook int cm; 76e69954b9Spbrook 77b95690c9SWei Huang for (cpu = 0; cpu < s->num_cpu; cpu++) { 789ee6e8bbSpbrook cm = 1 << cpu; 799ee6e8bbSpbrook s->current_pending[cpu] = 1023; 80679aa175SFabian Aggeler if (!(s->ctlr & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1)) 8132951860SFabian Aggeler || !(s->cpu_ctlr[cpu] & (GICC_CTLR_EN_GRP0 | GICC_CTLR_EN_GRP1))) { 829ee6e8bbSpbrook qemu_irq_lower(s->parent_irq[cpu]); 83dadbb58fSPeter Maydell qemu_irq_lower(s->parent_fiq[cpu]); 84235069a3SJohan Karlsson continue; 85e69954b9Spbrook } 86e69954b9Spbrook best_prio = 0x100; 87e69954b9Spbrook best_irq = 1023; 88a32134aaSMark Langsdorf for (irq = 0; irq < s->num_irq; irq++) { 89b52b81e4SSergey Fedorov if (GIC_TEST_ENABLED(irq, cm) && gic_test_pending(s, irq, cm) && 90b52b81e4SSergey Fedorov (irq < GIC_INTERNAL || GIC_TARGET(irq) & cm)) { 919ee6e8bbSpbrook if (GIC_GET_PRIORITY(irq, cpu) < best_prio) { 929ee6e8bbSpbrook best_prio = GIC_GET_PRIORITY(irq, cpu); 93e69954b9Spbrook best_irq = irq; 94e69954b9Spbrook } 95e69954b9Spbrook } 96e69954b9Spbrook } 97dadbb58fSPeter Maydell 982531088fSHollis Blanchard if (best_irq != 1023) { 992531088fSHollis Blanchard trace_gic_update_bestirq(cpu, best_irq, best_prio, 1002531088fSHollis Blanchard s->priority_mask[cpu], s->running_priority[cpu]); 1012531088fSHollis Blanchard } 1022531088fSHollis Blanchard 103dadbb58fSPeter Maydell irq_level = fiq_level = 0; 104dadbb58fSPeter Maydell 105cad065f1SPeter Maydell if (best_prio < s->priority_mask[cpu]) { 1069ee6e8bbSpbrook s->current_pending[cpu] = best_irq; 1079ee6e8bbSpbrook if (best_prio < s->running_priority[cpu]) { 108dadbb58fSPeter Maydell int group = GIC_TEST_GROUP(best_irq, cm); 109dadbb58fSPeter Maydell 110dadbb58fSPeter Maydell if (extract32(s->ctlr, group, 1) && 111dadbb58fSPeter Maydell extract32(s->cpu_ctlr[cpu], group, 1)) { 112dadbb58fSPeter Maydell if (group == 0 && s->cpu_ctlr[cpu] & GICC_CTLR_FIQ_EN) { 113dadbb58fSPeter Maydell DPRINTF("Raised pending FIQ %d (cpu %d)\n", 114dadbb58fSPeter Maydell best_irq, cpu); 115dadbb58fSPeter Maydell fiq_level = 1; 1162531088fSHollis Blanchard trace_gic_update_set_irq(cpu, "fiq", fiq_level); 117dadbb58fSPeter Maydell } else { 118dadbb58fSPeter Maydell DPRINTF("Raised pending IRQ %d (cpu %d)\n", 119dadbb58fSPeter Maydell best_irq, cpu); 120dadbb58fSPeter Maydell irq_level = 1; 1212531088fSHollis Blanchard trace_gic_update_set_irq(cpu, "irq", irq_level); 122e69954b9Spbrook } 123e69954b9Spbrook } 124dadbb58fSPeter Maydell } 125dadbb58fSPeter Maydell } 126dadbb58fSPeter Maydell 127dadbb58fSPeter Maydell qemu_set_irq(s->parent_irq[cpu], irq_level); 128dadbb58fSPeter Maydell qemu_set_irq(s->parent_fiq[cpu], fiq_level); 1299ee6e8bbSpbrook } 130e69954b9Spbrook } 131e69954b9Spbrook 132fae15286SPeter Maydell void gic_set_pending_private(GICState *s, int cpu, int irq) 1339ee6e8bbSpbrook { 1349ee6e8bbSpbrook int cm = 1 << cpu; 1359ee6e8bbSpbrook 1368d999995SChristoffer Dall if (gic_test_pending(s, irq, cm)) { 1379ee6e8bbSpbrook return; 1388d999995SChristoffer Dall } 1399ee6e8bbSpbrook 1409ee6e8bbSpbrook DPRINTF("Set %d pending cpu %d\n", irq, cpu); 1419ee6e8bbSpbrook GIC_SET_PENDING(irq, cm); 1429ee6e8bbSpbrook gic_update(s); 1439ee6e8bbSpbrook } 1449ee6e8bbSpbrook 1458d999995SChristoffer Dall static void gic_set_irq_11mpcore(GICState *s, int irq, int level, 1468d999995SChristoffer Dall int cm, int target) 1478d999995SChristoffer Dall { 1488d999995SChristoffer Dall if (level) { 1498d999995SChristoffer Dall GIC_SET_LEVEL(irq, cm); 1508d999995SChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq) || GIC_TEST_ENABLED(irq, cm)) { 1518d999995SChristoffer Dall DPRINTF("Set %d pending mask %x\n", irq, target); 1528d999995SChristoffer Dall GIC_SET_PENDING(irq, target); 1538d999995SChristoffer Dall } 1548d999995SChristoffer Dall } else { 1558d999995SChristoffer Dall GIC_CLEAR_LEVEL(irq, cm); 1568d999995SChristoffer Dall } 1578d999995SChristoffer Dall } 1588d999995SChristoffer Dall 1598d999995SChristoffer Dall static void gic_set_irq_generic(GICState *s, int irq, int level, 1608d999995SChristoffer Dall int cm, int target) 1618d999995SChristoffer Dall { 1628d999995SChristoffer Dall if (level) { 1638d999995SChristoffer Dall GIC_SET_LEVEL(irq, cm); 1648d999995SChristoffer Dall DPRINTF("Set %d pending mask %x\n", irq, target); 1658d999995SChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq)) { 1668d999995SChristoffer Dall GIC_SET_PENDING(irq, target); 1678d999995SChristoffer Dall } 1688d999995SChristoffer Dall } else { 1698d999995SChristoffer Dall GIC_CLEAR_LEVEL(irq, cm); 1708d999995SChristoffer Dall } 1718d999995SChristoffer Dall } 1728d999995SChristoffer Dall 1739ee6e8bbSpbrook /* Process a change in an external IRQ input. */ 174e69954b9Spbrook static void gic_set_irq(void *opaque, int irq, int level) 175e69954b9Spbrook { 176544d1afaSPeter Maydell /* Meaning of the 'irq' parameter: 177544d1afaSPeter Maydell * [0..N-1] : external interrupts 178544d1afaSPeter Maydell * [N..N+31] : PPI (internal) interrupts for CPU 0 179544d1afaSPeter Maydell * [N+32..N+63] : PPI (internal interrupts for CPU 1 180544d1afaSPeter Maydell * ... 181544d1afaSPeter Maydell */ 182fae15286SPeter Maydell GICState *s = (GICState *)opaque; 183544d1afaSPeter Maydell int cm, target; 184544d1afaSPeter Maydell if (irq < (s->num_irq - GIC_INTERNAL)) { 185e69954b9Spbrook /* The first external input line is internal interrupt 32. */ 186544d1afaSPeter Maydell cm = ALL_CPU_MASK; 18769253800SRusty Russell irq += GIC_INTERNAL; 188544d1afaSPeter Maydell target = GIC_TARGET(irq); 189544d1afaSPeter Maydell } else { 190544d1afaSPeter Maydell int cpu; 191544d1afaSPeter Maydell irq -= (s->num_irq - GIC_INTERNAL); 192544d1afaSPeter Maydell cpu = irq / GIC_INTERNAL; 193544d1afaSPeter Maydell irq %= GIC_INTERNAL; 194544d1afaSPeter Maydell cm = 1 << cpu; 195544d1afaSPeter Maydell target = cm; 196544d1afaSPeter Maydell } 197544d1afaSPeter Maydell 19840d22500SChristoffer Dall assert(irq >= GIC_NR_SGIS); 19940d22500SChristoffer Dall 200544d1afaSPeter Maydell if (level == GIC_TEST_LEVEL(irq, cm)) { 201e69954b9Spbrook return; 202544d1afaSPeter Maydell } 203e69954b9Spbrook 2043bc4b52cSMarcin Krzeminski if (s->revision == REV_11MPCORE) { 2058d999995SChristoffer Dall gic_set_irq_11mpcore(s, irq, level, cm, target); 206e69954b9Spbrook } else { 2078d999995SChristoffer Dall gic_set_irq_generic(s, irq, level, cm, target); 208e69954b9Spbrook } 2092531088fSHollis Blanchard trace_gic_set_irq(irq, level, cm, target); 2108d999995SChristoffer Dall 211e69954b9Spbrook gic_update(s); 212e69954b9Spbrook } 213e69954b9Spbrook 2147c0fa108SFabian Aggeler static uint16_t gic_get_current_pending_irq(GICState *s, int cpu, 2157c0fa108SFabian Aggeler MemTxAttrs attrs) 2167c0fa108SFabian Aggeler { 2177c0fa108SFabian Aggeler uint16_t pending_irq = s->current_pending[cpu]; 2187c0fa108SFabian Aggeler 2197c0fa108SFabian Aggeler if (pending_irq < GIC_MAXIRQ && gic_has_groups(s)) { 2207c0fa108SFabian Aggeler int group = GIC_TEST_GROUP(pending_irq, (1 << cpu)); 2217c0fa108SFabian Aggeler /* On a GIC without the security extensions, reading this register 2227c0fa108SFabian Aggeler * behaves in the same way as a secure access to a GIC with them. 2237c0fa108SFabian Aggeler */ 2247c0fa108SFabian Aggeler bool secure = !s->security_extn || attrs.secure; 2257c0fa108SFabian Aggeler 2267c0fa108SFabian Aggeler if (group == 0 && !secure) { 2277c0fa108SFabian Aggeler /* Group0 interrupts hidden from Non-secure access */ 2287c0fa108SFabian Aggeler return 1023; 2297c0fa108SFabian Aggeler } 2307c0fa108SFabian Aggeler if (group == 1 && secure && !(s->cpu_ctlr[cpu] & GICC_CTLR_ACK_CTL)) { 2317c0fa108SFabian Aggeler /* Group1 interrupts only seen by Secure access if 2327c0fa108SFabian Aggeler * AckCtl bit set. 2337c0fa108SFabian Aggeler */ 2347c0fa108SFabian Aggeler return 1022; 2357c0fa108SFabian Aggeler } 2367c0fa108SFabian Aggeler } 2377c0fa108SFabian Aggeler return pending_irq; 2387c0fa108SFabian Aggeler } 2397c0fa108SFabian Aggeler 240df92cfa6SPeter Maydell static int gic_get_group_priority(GICState *s, int cpu, int irq) 241df92cfa6SPeter Maydell { 242df92cfa6SPeter Maydell /* Return the group priority of the specified interrupt 243df92cfa6SPeter Maydell * (which is the top bits of its priority, with the number 244df92cfa6SPeter Maydell * of bits masked determined by the applicable binary point register). 245df92cfa6SPeter Maydell */ 246df92cfa6SPeter Maydell int bpr; 247df92cfa6SPeter Maydell uint32_t mask; 248df92cfa6SPeter Maydell 249df92cfa6SPeter Maydell if (gic_has_groups(s) && 250df92cfa6SPeter Maydell !(s->cpu_ctlr[cpu] & GICC_CTLR_CBPR) && 251df92cfa6SPeter Maydell GIC_TEST_GROUP(irq, (1 << cpu))) { 252df92cfa6SPeter Maydell bpr = s->abpr[cpu]; 253df92cfa6SPeter Maydell } else { 254df92cfa6SPeter Maydell bpr = s->bpr[cpu]; 255df92cfa6SPeter Maydell } 256df92cfa6SPeter Maydell 257df92cfa6SPeter Maydell /* a BPR of 0 means the group priority bits are [7:1]; 258df92cfa6SPeter Maydell * a BPR of 1 means they are [7:2], and so on down to 259df92cfa6SPeter Maydell * a BPR of 7 meaning no group priority bits at all. 260df92cfa6SPeter Maydell */ 261df92cfa6SPeter Maydell mask = ~0U << ((bpr & 7) + 1); 262df92cfa6SPeter Maydell 263df92cfa6SPeter Maydell return GIC_GET_PRIORITY(irq, cpu) & mask; 264df92cfa6SPeter Maydell } 265df92cfa6SPeter Maydell 26672889c8aSPeter Maydell static void gic_activate_irq(GICState *s, int cpu, int irq) 267e69954b9Spbrook { 26872889c8aSPeter Maydell /* Set the appropriate Active Priority Register bit for this IRQ, 26972889c8aSPeter Maydell * and update the running priority. 27072889c8aSPeter Maydell */ 27172889c8aSPeter Maydell int prio = gic_get_group_priority(s, cpu, irq); 27272889c8aSPeter Maydell int preemption_level = prio >> (GIC_MIN_BPR + 1); 27372889c8aSPeter Maydell int regno = preemption_level / 32; 27472889c8aSPeter Maydell int bitno = preemption_level % 32; 27572889c8aSPeter Maydell 27672889c8aSPeter Maydell if (gic_has_groups(s) && GIC_TEST_GROUP(irq, (1 << cpu))) { 277a8595957SFrançois Baldassari s->nsapr[regno][cpu] |= (1 << bitno); 2789ee6e8bbSpbrook } else { 279a8595957SFrançois Baldassari s->apr[regno][cpu] |= (1 << bitno); 2809ee6e8bbSpbrook } 28172889c8aSPeter Maydell 28272889c8aSPeter Maydell s->running_priority[cpu] = prio; 283d5523a13SPeter Maydell GIC_SET_ACTIVE(irq, 1 << cpu); 28472889c8aSPeter Maydell } 28572889c8aSPeter Maydell 28672889c8aSPeter Maydell static int gic_get_prio_from_apr_bits(GICState *s, int cpu) 28772889c8aSPeter Maydell { 28872889c8aSPeter Maydell /* Recalculate the current running priority for this CPU based 28972889c8aSPeter Maydell * on the set bits in the Active Priority Registers. 29072889c8aSPeter Maydell */ 29172889c8aSPeter Maydell int i; 29272889c8aSPeter Maydell for (i = 0; i < GIC_NR_APRS; i++) { 29372889c8aSPeter Maydell uint32_t apr = s->apr[i][cpu] | s->nsapr[i][cpu]; 29472889c8aSPeter Maydell if (!apr) { 29572889c8aSPeter Maydell continue; 29672889c8aSPeter Maydell } 29772889c8aSPeter Maydell return (i * 32 + ctz32(apr)) << (GIC_MIN_BPR + 1); 29872889c8aSPeter Maydell } 29972889c8aSPeter Maydell return 0x100; 30072889c8aSPeter Maydell } 30172889c8aSPeter Maydell 30272889c8aSPeter Maydell static void gic_drop_prio(GICState *s, int cpu, int group) 30372889c8aSPeter Maydell { 30472889c8aSPeter Maydell /* Drop the priority of the currently active interrupt in the 30572889c8aSPeter Maydell * specified group. 30672889c8aSPeter Maydell * 30772889c8aSPeter Maydell * Note that we can guarantee (because of the requirement to nest 30872889c8aSPeter Maydell * GICC_IAR reads [which activate an interrupt and raise priority] 30972889c8aSPeter Maydell * with GICC_EOIR writes [which drop the priority for the interrupt]) 31072889c8aSPeter Maydell * that the interrupt we're being called for is the highest priority 31172889c8aSPeter Maydell * active interrupt, meaning that it has the lowest set bit in the 31272889c8aSPeter Maydell * APR registers. 31372889c8aSPeter Maydell * 31472889c8aSPeter Maydell * If the guest does not honour the ordering constraints then the 31572889c8aSPeter Maydell * behaviour of the GIC is UNPREDICTABLE, which for us means that 31672889c8aSPeter Maydell * the values of the APR registers might become incorrect and the 31772889c8aSPeter Maydell * running priority will be wrong, so interrupts that should preempt 31872889c8aSPeter Maydell * might not do so, and interrupts that should not preempt might do so. 31972889c8aSPeter Maydell */ 32072889c8aSPeter Maydell int i; 32172889c8aSPeter Maydell 32272889c8aSPeter Maydell for (i = 0; i < GIC_NR_APRS; i++) { 32372889c8aSPeter Maydell uint32_t *papr = group ? &s->nsapr[i][cpu] : &s->apr[i][cpu]; 32472889c8aSPeter Maydell if (!*papr) { 32572889c8aSPeter Maydell continue; 32672889c8aSPeter Maydell } 32772889c8aSPeter Maydell /* Clear lowest set bit */ 32872889c8aSPeter Maydell *papr &= *papr - 1; 32972889c8aSPeter Maydell break; 33072889c8aSPeter Maydell } 33172889c8aSPeter Maydell 33272889c8aSPeter Maydell s->running_priority[cpu] = gic_get_prio_from_apr_bits(s, cpu); 333e69954b9Spbrook } 334e69954b9Spbrook 335c5619bf9SFabian Aggeler uint32_t gic_acknowledge_irq(GICState *s, int cpu, MemTxAttrs attrs) 336e69954b9Spbrook { 33740d22500SChristoffer Dall int ret, irq, src; 3389ee6e8bbSpbrook int cm = 1 << cpu; 339c5619bf9SFabian Aggeler 340c5619bf9SFabian Aggeler /* gic_get_current_pending_irq() will return 1022 or 1023 appropriately 341c5619bf9SFabian Aggeler * for the case where this GIC supports grouping and the pending interrupt 342c5619bf9SFabian Aggeler * is in the wrong group. 343c5619bf9SFabian Aggeler */ 344a8f15a27SDaniel P. Berrange irq = gic_get_current_pending_irq(s, cpu, attrs); 3452531088fSHollis Blanchard trace_gic_acknowledge_irq(cpu, irq); 346c5619bf9SFabian Aggeler 347c5619bf9SFabian Aggeler if (irq >= GIC_MAXIRQ) { 348c5619bf9SFabian Aggeler DPRINTF("ACK, no pending interrupt or it is hidden: %d\n", irq); 349c5619bf9SFabian Aggeler return irq; 350c5619bf9SFabian Aggeler } 351c5619bf9SFabian Aggeler 352c5619bf9SFabian Aggeler if (GIC_GET_PRIORITY(irq, cpu) >= s->running_priority[cpu]) { 353c5619bf9SFabian Aggeler DPRINTF("ACK, pending interrupt (%d) has insufficient priority\n", irq); 354e69954b9Spbrook return 1023; 355e69954b9Spbrook } 35640d22500SChristoffer Dall 357*7c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 3589ee6e8bbSpbrook /* Clear pending flags for both level and edge triggered interrupts. 35940d22500SChristoffer Dall * Level triggered IRQs will be reasserted once they become inactive. 36040d22500SChristoffer Dall */ 36140d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 36240d22500SChristoffer Dall ret = irq; 36340d22500SChristoffer Dall } else { 36440d22500SChristoffer Dall if (irq < GIC_NR_SGIS) { 36540d22500SChristoffer Dall /* Lookup the source CPU for the SGI and clear this in the 36640d22500SChristoffer Dall * sgi_pending map. Return the src and clear the overall pending 36740d22500SChristoffer Dall * state on this CPU if the SGI is not pending from any CPUs. 36840d22500SChristoffer Dall */ 36940d22500SChristoffer Dall assert(s->sgi_pending[irq][cpu] != 0); 37040d22500SChristoffer Dall src = ctz32(s->sgi_pending[irq][cpu]); 37140d22500SChristoffer Dall s->sgi_pending[irq][cpu] &= ~(1 << src); 37240d22500SChristoffer Dall if (s->sgi_pending[irq][cpu] == 0) { 37340d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 37440d22500SChristoffer Dall } 37540d22500SChristoffer Dall ret = irq | ((src & 0x7) << 10); 37640d22500SChristoffer Dall } else { 37740d22500SChristoffer Dall /* Clear pending state for both level and edge triggered 37840d22500SChristoffer Dall * interrupts. (level triggered interrupts with an active line 37940d22500SChristoffer Dall * remain pending, see gic_test_pending) 38040d22500SChristoffer Dall */ 38140d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 38240d22500SChristoffer Dall ret = irq; 38340d22500SChristoffer Dall } 38440d22500SChristoffer Dall } 38540d22500SChristoffer Dall 38672889c8aSPeter Maydell gic_activate_irq(s, cpu, irq); 38772889c8aSPeter Maydell gic_update(s); 38840d22500SChristoffer Dall DPRINTF("ACK %d\n", irq); 38940d22500SChristoffer Dall return ret; 390e69954b9Spbrook } 391e69954b9Spbrook 39281508470SFabian Aggeler void gic_set_priority(GICState *s, int cpu, int irq, uint8_t val, 39381508470SFabian Aggeler MemTxAttrs attrs) 3949df90ad0SChristoffer Dall { 39581508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 39681508470SFabian Aggeler if (!GIC_TEST_GROUP(irq, (1 << cpu))) { 39781508470SFabian Aggeler return; /* Ignore Non-secure access of Group0 IRQ */ 39881508470SFabian Aggeler } 39981508470SFabian Aggeler val = 0x80 | (val >> 1); /* Non-secure view */ 40081508470SFabian Aggeler } 40181508470SFabian Aggeler 4029df90ad0SChristoffer Dall if (irq < GIC_INTERNAL) { 4039df90ad0SChristoffer Dall s->priority1[irq][cpu] = val; 4049df90ad0SChristoffer Dall } else { 4059df90ad0SChristoffer Dall s->priority2[(irq) - GIC_INTERNAL] = val; 4069df90ad0SChristoffer Dall } 4079df90ad0SChristoffer Dall } 4089df90ad0SChristoffer Dall 40981508470SFabian Aggeler static uint32_t gic_get_priority(GICState *s, int cpu, int irq, 41081508470SFabian Aggeler MemTxAttrs attrs) 41181508470SFabian Aggeler { 41281508470SFabian Aggeler uint32_t prio = GIC_GET_PRIORITY(irq, cpu); 41381508470SFabian Aggeler 41481508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 41581508470SFabian Aggeler if (!GIC_TEST_GROUP(irq, (1 << cpu))) { 41681508470SFabian Aggeler return 0; /* Non-secure access cannot read priority of Group0 IRQ */ 41781508470SFabian Aggeler } 41881508470SFabian Aggeler prio = (prio << 1) & 0xff; /* Non-secure view */ 41981508470SFabian Aggeler } 42081508470SFabian Aggeler return prio; 42181508470SFabian Aggeler } 42281508470SFabian Aggeler 42381508470SFabian Aggeler static void gic_set_priority_mask(GICState *s, int cpu, uint8_t pmask, 42481508470SFabian Aggeler MemTxAttrs attrs) 42581508470SFabian Aggeler { 42681508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 42781508470SFabian Aggeler if (s->priority_mask[cpu] & 0x80) { 42881508470SFabian Aggeler /* Priority Mask in upper half */ 42981508470SFabian Aggeler pmask = 0x80 | (pmask >> 1); 43081508470SFabian Aggeler } else { 43181508470SFabian Aggeler /* Non-secure write ignored if priority mask is in lower half */ 43281508470SFabian Aggeler return; 43381508470SFabian Aggeler } 43481508470SFabian Aggeler } 43581508470SFabian Aggeler s->priority_mask[cpu] = pmask; 43681508470SFabian Aggeler } 43781508470SFabian Aggeler 43881508470SFabian Aggeler static uint32_t gic_get_priority_mask(GICState *s, int cpu, MemTxAttrs attrs) 43981508470SFabian Aggeler { 44081508470SFabian Aggeler uint32_t pmask = s->priority_mask[cpu]; 44181508470SFabian Aggeler 44281508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 44381508470SFabian Aggeler if (pmask & 0x80) { 44481508470SFabian Aggeler /* Priority Mask in upper half, return Non-secure view */ 44581508470SFabian Aggeler pmask = (pmask << 1) & 0xff; 44681508470SFabian Aggeler } else { 44781508470SFabian Aggeler /* Priority Mask in lower half, RAZ */ 44881508470SFabian Aggeler pmask = 0; 44981508470SFabian Aggeler } 45081508470SFabian Aggeler } 45181508470SFabian Aggeler return pmask; 45281508470SFabian Aggeler } 45381508470SFabian Aggeler 45432951860SFabian Aggeler static uint32_t gic_get_cpu_control(GICState *s, int cpu, MemTxAttrs attrs) 45532951860SFabian Aggeler { 45632951860SFabian Aggeler uint32_t ret = s->cpu_ctlr[cpu]; 45732951860SFabian Aggeler 45832951860SFabian Aggeler if (s->security_extn && !attrs.secure) { 45932951860SFabian Aggeler /* Construct the NS banked view of GICC_CTLR from the correct 46032951860SFabian Aggeler * bits of the S banked view. We don't need to move the bypass 46132951860SFabian Aggeler * control bits because we don't implement that (IMPDEF) part 46232951860SFabian Aggeler * of the GIC architecture. 46332951860SFabian Aggeler */ 46432951860SFabian Aggeler ret = (ret & (GICC_CTLR_EN_GRP1 | GICC_CTLR_EOIMODE_NS)) >> 1; 46532951860SFabian Aggeler } 46632951860SFabian Aggeler return ret; 46732951860SFabian Aggeler } 46832951860SFabian Aggeler 46932951860SFabian Aggeler static void gic_set_cpu_control(GICState *s, int cpu, uint32_t value, 47032951860SFabian Aggeler MemTxAttrs attrs) 47132951860SFabian Aggeler { 47232951860SFabian Aggeler uint32_t mask; 47332951860SFabian Aggeler 47432951860SFabian Aggeler if (s->security_extn && !attrs.secure) { 47532951860SFabian Aggeler /* The NS view can only write certain bits in the register; 47632951860SFabian Aggeler * the rest are unchanged 47732951860SFabian Aggeler */ 47832951860SFabian Aggeler mask = GICC_CTLR_EN_GRP1; 47932951860SFabian Aggeler if (s->revision == 2) { 48032951860SFabian Aggeler mask |= GICC_CTLR_EOIMODE_NS; 48132951860SFabian Aggeler } 48232951860SFabian Aggeler s->cpu_ctlr[cpu] &= ~mask; 48332951860SFabian Aggeler s->cpu_ctlr[cpu] |= (value << 1) & mask; 48432951860SFabian Aggeler } else { 48532951860SFabian Aggeler if (s->revision == 2) { 48632951860SFabian Aggeler mask = s->security_extn ? GICC_CTLR_V2_S_MASK : GICC_CTLR_V2_MASK; 48732951860SFabian Aggeler } else { 48832951860SFabian Aggeler mask = s->security_extn ? GICC_CTLR_V1_S_MASK : GICC_CTLR_V1_MASK; 48932951860SFabian Aggeler } 49032951860SFabian Aggeler s->cpu_ctlr[cpu] = value & mask; 49132951860SFabian Aggeler } 49232951860SFabian Aggeler DPRINTF("CPU Interface %d: Group0 Interrupts %sabled, " 49332951860SFabian Aggeler "Group1 Interrupts %sabled\n", cpu, 49432951860SFabian Aggeler (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP0) ? "En" : "Dis", 49532951860SFabian Aggeler (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP1) ? "En" : "Dis"); 49632951860SFabian Aggeler } 49732951860SFabian Aggeler 49808efa9f2SFabian Aggeler static uint8_t gic_get_running_priority(GICState *s, int cpu, MemTxAttrs attrs) 49908efa9f2SFabian Aggeler { 50008efa9f2SFabian Aggeler if (s->security_extn && !attrs.secure) { 50108efa9f2SFabian Aggeler if (s->running_priority[cpu] & 0x80) { 50208efa9f2SFabian Aggeler /* Running priority in upper half of range: return the Non-secure 50308efa9f2SFabian Aggeler * view of the priority. 50408efa9f2SFabian Aggeler */ 50508efa9f2SFabian Aggeler return s->running_priority[cpu] << 1; 50608efa9f2SFabian Aggeler } else { 50708efa9f2SFabian Aggeler /* Running priority in lower half of range: RAZ */ 50808efa9f2SFabian Aggeler return 0; 50908efa9f2SFabian Aggeler } 51008efa9f2SFabian Aggeler } else { 51108efa9f2SFabian Aggeler return s->running_priority[cpu]; 51208efa9f2SFabian Aggeler } 51308efa9f2SFabian Aggeler } 51408efa9f2SFabian Aggeler 515a55c910eSPeter Maydell /* Return true if we should split priority drop and interrupt deactivation, 516a55c910eSPeter Maydell * ie whether the relevant EOIMode bit is set. 517a55c910eSPeter Maydell */ 518a55c910eSPeter Maydell static bool gic_eoi_split(GICState *s, int cpu, MemTxAttrs attrs) 519a55c910eSPeter Maydell { 520a55c910eSPeter Maydell if (s->revision != 2) { 521a55c910eSPeter Maydell /* Before GICv2 prio-drop and deactivate are not separable */ 522a55c910eSPeter Maydell return false; 523a55c910eSPeter Maydell } 524a55c910eSPeter Maydell if (s->security_extn && !attrs.secure) { 525a55c910eSPeter Maydell return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE_NS; 526a55c910eSPeter Maydell } 527a55c910eSPeter Maydell return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE; 528a55c910eSPeter Maydell } 529a55c910eSPeter Maydell 530a55c910eSPeter Maydell static void gic_deactivate_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs) 531a55c910eSPeter Maydell { 532a55c910eSPeter Maydell int cm = 1 << cpu; 533a55c910eSPeter Maydell int group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm); 534a55c910eSPeter Maydell 535a55c910eSPeter Maydell if (!gic_eoi_split(s, cpu, attrs)) { 536a55c910eSPeter Maydell /* This is UNPREDICTABLE; we choose to ignore it */ 537a55c910eSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 538a55c910eSPeter Maydell "gic_deactivate_irq: GICC_DIR write when EOIMode clear"); 539a55c910eSPeter Maydell return; 540a55c910eSPeter Maydell } 541a55c910eSPeter Maydell 542a55c910eSPeter Maydell if (s->security_extn && !attrs.secure && !group) { 543a55c910eSPeter Maydell DPRINTF("Non-secure DI for Group0 interrupt %d ignored\n", irq); 544a55c910eSPeter Maydell return; 545a55c910eSPeter Maydell } 546a55c910eSPeter Maydell 547a55c910eSPeter Maydell GIC_CLEAR_ACTIVE(irq, cm); 548a55c910eSPeter Maydell } 549a55c910eSPeter Maydell 550f9c6a7f1SFabian Aggeler void gic_complete_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs) 551e69954b9Spbrook { 5529ee6e8bbSpbrook int cm = 1 << cpu; 55372889c8aSPeter Maydell int group; 55472889c8aSPeter Maydell 555df628ff1Spbrook DPRINTF("EOI %d\n", irq); 556a32134aaSMark Langsdorf if (irq >= s->num_irq) { 557217bfb44SPeter Maydell /* This handles two cases: 558217bfb44SPeter Maydell * 1. If software writes the ID of a spurious interrupt [ie 1023] 559217bfb44SPeter Maydell * to the GICC_EOIR, the GIC ignores that write. 560217bfb44SPeter Maydell * 2. If software writes the number of a non-existent interrupt 561217bfb44SPeter Maydell * this must be a subcase of "value written does not match the last 562217bfb44SPeter Maydell * valid interrupt value read from the Interrupt Acknowledge 563217bfb44SPeter Maydell * register" and so this is UNPREDICTABLE. We choose to ignore it. 564217bfb44SPeter Maydell */ 565217bfb44SPeter Maydell return; 566217bfb44SPeter Maydell } 56772889c8aSPeter Maydell if (s->running_priority[cpu] == 0x100) { 568e69954b9Spbrook return; /* No active IRQ. */ 56972889c8aSPeter Maydell } 5708d999995SChristoffer Dall 5713bc4b52cSMarcin Krzeminski if (s->revision == REV_11MPCORE) { 572e69954b9Spbrook /* Mark level triggered interrupts as pending if they are still 573e69954b9Spbrook raised. */ 57404050c5cSChristoffer Dall if (!GIC_TEST_EDGE_TRIGGER(irq) && GIC_TEST_ENABLED(irq, cm) 5759ee6e8bbSpbrook && GIC_TEST_LEVEL(irq, cm) && (GIC_TARGET(irq) & cm) != 0) { 5769ee6e8bbSpbrook DPRINTF("Set %d pending mask %x\n", irq, cm); 5779ee6e8bbSpbrook GIC_SET_PENDING(irq, cm); 578e69954b9Spbrook } 5798d999995SChristoffer Dall } 5808d999995SChristoffer Dall 58172889c8aSPeter Maydell group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm); 58272889c8aSPeter Maydell 58372889c8aSPeter Maydell if (s->security_extn && !attrs.secure && !group) { 584f9c6a7f1SFabian Aggeler DPRINTF("Non-secure EOI for Group0 interrupt %d ignored\n", irq); 585f9c6a7f1SFabian Aggeler return; 586f9c6a7f1SFabian Aggeler } 587f9c6a7f1SFabian Aggeler 588f9c6a7f1SFabian Aggeler /* Secure EOI with GICC_CTLR.AckCtl == 0 when the IRQ is a Group 1 589f9c6a7f1SFabian Aggeler * interrupt is UNPREDICTABLE. We choose to handle it as if AckCtl == 1, 590f9c6a7f1SFabian Aggeler * i.e. go ahead and complete the irq anyway. 591f9c6a7f1SFabian Aggeler */ 592f9c6a7f1SFabian Aggeler 59372889c8aSPeter Maydell gic_drop_prio(s, cpu, group); 594a55c910eSPeter Maydell 595a55c910eSPeter Maydell /* In GICv2 the guest can choose to split priority-drop and deactivate */ 596a55c910eSPeter Maydell if (!gic_eoi_split(s, cpu, attrs)) { 597d5523a13SPeter Maydell GIC_CLEAR_ACTIVE(irq, cm); 598a55c910eSPeter Maydell } 599e69954b9Spbrook gic_update(s); 600e69954b9Spbrook } 601e69954b9Spbrook 602a9d85353SPeter Maydell static uint32_t gic_dist_readb(void *opaque, hwaddr offset, MemTxAttrs attrs) 603e69954b9Spbrook { 604fae15286SPeter Maydell GICState *s = (GICState *)opaque; 605e69954b9Spbrook uint32_t res; 606e69954b9Spbrook int irq; 607e69954b9Spbrook int i; 6089ee6e8bbSpbrook int cpu; 6099ee6e8bbSpbrook int cm; 6109ee6e8bbSpbrook int mask; 611e69954b9Spbrook 612926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 6139ee6e8bbSpbrook cm = 1 << cpu; 614e69954b9Spbrook if (offset < 0x100) { 615679aa175SFabian Aggeler if (offset == 0) { /* GICD_CTLR */ 616679aa175SFabian Aggeler if (s->security_extn && !attrs.secure) { 617679aa175SFabian Aggeler /* The NS bank of this register is just an alias of the 618679aa175SFabian Aggeler * EnableGrp1 bit in the S bank version. 619679aa175SFabian Aggeler */ 620679aa175SFabian Aggeler return extract32(s->ctlr, 1, 1); 621679aa175SFabian Aggeler } else { 622679aa175SFabian Aggeler return s->ctlr; 623679aa175SFabian Aggeler } 624679aa175SFabian Aggeler } 625e69954b9Spbrook if (offset == 4) 6265543d1abSFabian Aggeler /* Interrupt Controller Type Register */ 6275543d1abSFabian Aggeler return ((s->num_irq / 32) - 1) 628b95690c9SWei Huang | ((s->num_cpu - 1) << 5) 6295543d1abSFabian Aggeler | (s->security_extn << 10); 630e69954b9Spbrook if (offset < 0x08) 631e69954b9Spbrook return 0; 632b79f2265SRob Herring if (offset >= 0x80) { 633c27a5ba9SFabian Aggeler /* Interrupt Group Registers: these RAZ/WI if this is an NS 634c27a5ba9SFabian Aggeler * access to a GIC with the security extensions, or if the GIC 635c27a5ba9SFabian Aggeler * doesn't have groups at all. 636c27a5ba9SFabian Aggeler */ 637c27a5ba9SFabian Aggeler res = 0; 638c27a5ba9SFabian Aggeler if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) { 639c27a5ba9SFabian Aggeler /* Every byte offset holds 8 group status bits */ 640c27a5ba9SFabian Aggeler irq = (offset - 0x080) * 8 + GIC_BASE_IRQ; 641c27a5ba9SFabian Aggeler if (irq >= s->num_irq) { 642c27a5ba9SFabian Aggeler goto bad_reg; 643c27a5ba9SFabian Aggeler } 644c27a5ba9SFabian Aggeler for (i = 0; i < 8; i++) { 645c27a5ba9SFabian Aggeler if (GIC_TEST_GROUP(irq + i, cm)) { 646c27a5ba9SFabian Aggeler res |= (1 << i); 647c27a5ba9SFabian Aggeler } 648c27a5ba9SFabian Aggeler } 649c27a5ba9SFabian Aggeler } 650c27a5ba9SFabian Aggeler return res; 651b79f2265SRob Herring } 652e69954b9Spbrook goto bad_reg; 653e69954b9Spbrook } else if (offset < 0x200) { 654e69954b9Spbrook /* Interrupt Set/Clear Enable. */ 655e69954b9Spbrook if (offset < 0x180) 656e69954b9Spbrook irq = (offset - 0x100) * 8; 657e69954b9Spbrook else 658e69954b9Spbrook irq = (offset - 0x180) * 8; 6599ee6e8bbSpbrook irq += GIC_BASE_IRQ; 660a32134aaSMark Langsdorf if (irq >= s->num_irq) 661e69954b9Spbrook goto bad_reg; 662e69954b9Spbrook res = 0; 663e69954b9Spbrook for (i = 0; i < 8; i++) { 664fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 665fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 666fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 667fea8a08eSJens Wiklander } 668fea8a08eSJens Wiklander 66941bf234dSRabin Vincent if (GIC_TEST_ENABLED(irq + i, cm)) { 670e69954b9Spbrook res |= (1 << i); 671e69954b9Spbrook } 672e69954b9Spbrook } 673e69954b9Spbrook } else if (offset < 0x300) { 674e69954b9Spbrook /* Interrupt Set/Clear Pending. */ 675e69954b9Spbrook if (offset < 0x280) 676e69954b9Spbrook irq = (offset - 0x200) * 8; 677e69954b9Spbrook else 678e69954b9Spbrook irq = (offset - 0x280) * 8; 6799ee6e8bbSpbrook irq += GIC_BASE_IRQ; 680a32134aaSMark Langsdorf if (irq >= s->num_irq) 681e69954b9Spbrook goto bad_reg; 682e69954b9Spbrook res = 0; 68369253800SRusty Russell mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK; 684e69954b9Spbrook for (i = 0; i < 8; i++) { 685fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 686fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 687fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 688fea8a08eSJens Wiklander } 689fea8a08eSJens Wiklander 6908d999995SChristoffer Dall if (gic_test_pending(s, irq + i, mask)) { 691e69954b9Spbrook res |= (1 << i); 692e69954b9Spbrook } 693e69954b9Spbrook } 694e69954b9Spbrook } else if (offset < 0x400) { 695e69954b9Spbrook /* Interrupt Active. */ 6969ee6e8bbSpbrook irq = (offset - 0x300) * 8 + GIC_BASE_IRQ; 697a32134aaSMark Langsdorf if (irq >= s->num_irq) 698e69954b9Spbrook goto bad_reg; 699e69954b9Spbrook res = 0; 70069253800SRusty Russell mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK; 701e69954b9Spbrook for (i = 0; i < 8; i++) { 702fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 703fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 704fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 705fea8a08eSJens Wiklander } 706fea8a08eSJens Wiklander 7079ee6e8bbSpbrook if (GIC_TEST_ACTIVE(irq + i, mask)) { 708e69954b9Spbrook res |= (1 << i); 709e69954b9Spbrook } 710e69954b9Spbrook } 711e69954b9Spbrook } else if (offset < 0x800) { 712e69954b9Spbrook /* Interrupt Priority. */ 7139ee6e8bbSpbrook irq = (offset - 0x400) + GIC_BASE_IRQ; 714a32134aaSMark Langsdorf if (irq >= s->num_irq) 715e69954b9Spbrook goto bad_reg; 71681508470SFabian Aggeler res = gic_get_priority(s, cpu, irq, attrs); 717e69954b9Spbrook } else if (offset < 0xc00) { 718e69954b9Spbrook /* Interrupt CPU Target. */ 7196b9680bbSPeter Maydell if (s->num_cpu == 1 && s->revision != REV_11MPCORE) { 7206b9680bbSPeter Maydell /* For uniprocessor GICs these RAZ/WI */ 7216b9680bbSPeter Maydell res = 0; 7226b9680bbSPeter Maydell } else { 7239ee6e8bbSpbrook irq = (offset - 0x800) + GIC_BASE_IRQ; 7246b9680bbSPeter Maydell if (irq >= s->num_irq) { 725e69954b9Spbrook goto bad_reg; 7266b9680bbSPeter Maydell } 7279ee6e8bbSpbrook if (irq >= 29 && irq <= 31) { 7289ee6e8bbSpbrook res = cm; 7299ee6e8bbSpbrook } else { 7309ee6e8bbSpbrook res = GIC_TARGET(irq); 7319ee6e8bbSpbrook } 7326b9680bbSPeter Maydell } 733e69954b9Spbrook } else if (offset < 0xf00) { 734e69954b9Spbrook /* Interrupt Configuration. */ 73571a62046SAdam Lackorzynski irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ; 736a32134aaSMark Langsdorf if (irq >= s->num_irq) 737e69954b9Spbrook goto bad_reg; 738e69954b9Spbrook res = 0; 739e69954b9Spbrook for (i = 0; i < 4; i++) { 740fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 741fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 742fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 743fea8a08eSJens Wiklander } 744fea8a08eSJens Wiklander 745e69954b9Spbrook if (GIC_TEST_MODEL(irq + i)) 746e69954b9Spbrook res |= (1 << (i * 2)); 74704050c5cSChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq + i)) 748e69954b9Spbrook res |= (2 << (i * 2)); 749e69954b9Spbrook } 75040d22500SChristoffer Dall } else if (offset < 0xf10) { 75140d22500SChristoffer Dall goto bad_reg; 75240d22500SChristoffer Dall } else if (offset < 0xf30) { 753*7c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 75440d22500SChristoffer Dall goto bad_reg; 75540d22500SChristoffer Dall } 75640d22500SChristoffer Dall 75740d22500SChristoffer Dall if (offset < 0xf20) { 75840d22500SChristoffer Dall /* GICD_CPENDSGIRn */ 75940d22500SChristoffer Dall irq = (offset - 0xf10); 76040d22500SChristoffer Dall } else { 76140d22500SChristoffer Dall irq = (offset - 0xf20); 76240d22500SChristoffer Dall /* GICD_SPENDSGIRn */ 76340d22500SChristoffer Dall } 76440d22500SChristoffer Dall 765fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 766fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq, 1 << cpu)) { 767fea8a08eSJens Wiklander res = 0; /* Ignore Non-secure access of Group0 IRQ */ 768fea8a08eSJens Wiklander } else { 76940d22500SChristoffer Dall res = s->sgi_pending[irq][cpu]; 770fea8a08eSJens Wiklander } 7713355c360SAlistair Francis } else if (offset < 0xfd0) { 772e69954b9Spbrook goto bad_reg; 7733355c360SAlistair Francis } else if (offset < 0x1000) { 774e69954b9Spbrook if (offset & 3) { 775e69954b9Spbrook res = 0; 776e69954b9Spbrook } else { 7773355c360SAlistair Francis switch (s->revision) { 7783355c360SAlistair Francis case REV_11MPCORE: 7793355c360SAlistair Francis res = gic_id_11mpcore[(offset - 0xfd0) >> 2]; 7803355c360SAlistair Francis break; 7813355c360SAlistair Francis case 1: 7823355c360SAlistair Francis res = gic_id_gicv1[(offset - 0xfd0) >> 2]; 7833355c360SAlistair Francis break; 7843355c360SAlistair Francis case 2: 7853355c360SAlistair Francis res = gic_id_gicv2[(offset - 0xfd0) >> 2]; 7863355c360SAlistair Francis break; 7873355c360SAlistair Francis default: 7883355c360SAlistair Francis res = 0; 789e69954b9Spbrook } 790e69954b9Spbrook } 7913355c360SAlistair Francis } else { 7923355c360SAlistair Francis g_assert_not_reached(); 7933355c360SAlistair Francis } 794e69954b9Spbrook return res; 795e69954b9Spbrook bad_reg: 7968c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 7978c8dc39fSPeter Maydell "gic_dist_readb: Bad offset %x\n", (int)offset); 798e69954b9Spbrook return 0; 799e69954b9Spbrook } 800e69954b9Spbrook 801a9d85353SPeter Maydell static MemTxResult gic_dist_read(void *opaque, hwaddr offset, uint64_t *data, 802a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 803e69954b9Spbrook { 804a9d85353SPeter Maydell switch (size) { 805a9d85353SPeter Maydell case 1: 806a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 807a9d85353SPeter Maydell return MEMTX_OK; 808a9d85353SPeter Maydell case 2: 809a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 810a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8; 811a9d85353SPeter Maydell return MEMTX_OK; 812a9d85353SPeter Maydell case 4: 813a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 814a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8; 815a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 2, attrs) << 16; 816a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 3, attrs) << 24; 817a9d85353SPeter Maydell return MEMTX_OK; 818a9d85353SPeter Maydell default: 819a9d85353SPeter Maydell return MEMTX_ERROR; 820e69954b9Spbrook } 821e69954b9Spbrook } 822e69954b9Spbrook 823a8170e5eSAvi Kivity static void gic_dist_writeb(void *opaque, hwaddr offset, 824a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 825e69954b9Spbrook { 826fae15286SPeter Maydell GICState *s = (GICState *)opaque; 827e69954b9Spbrook int irq; 828e69954b9Spbrook int i; 8299ee6e8bbSpbrook int cpu; 830e69954b9Spbrook 831926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 832e69954b9Spbrook if (offset < 0x100) { 833e69954b9Spbrook if (offset == 0) { 834679aa175SFabian Aggeler if (s->security_extn && !attrs.secure) { 835679aa175SFabian Aggeler /* NS version is just an alias of the S version's bit 1 */ 836679aa175SFabian Aggeler s->ctlr = deposit32(s->ctlr, 1, 1, value); 837679aa175SFabian Aggeler } else if (gic_has_groups(s)) { 838679aa175SFabian Aggeler s->ctlr = value & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1); 839679aa175SFabian Aggeler } else { 840679aa175SFabian Aggeler s->ctlr = value & GICD_CTLR_EN_GRP0; 841679aa175SFabian Aggeler } 842679aa175SFabian Aggeler DPRINTF("Distributor: Group0 %sabled; Group 1 %sabled\n", 843679aa175SFabian Aggeler s->ctlr & GICD_CTLR_EN_GRP0 ? "En" : "Dis", 844679aa175SFabian Aggeler s->ctlr & GICD_CTLR_EN_GRP1 ? "En" : "Dis"); 845e69954b9Spbrook } else if (offset < 4) { 846e69954b9Spbrook /* ignored. */ 847b79f2265SRob Herring } else if (offset >= 0x80) { 848c27a5ba9SFabian Aggeler /* Interrupt Group Registers: RAZ/WI for NS access to secure 849c27a5ba9SFabian Aggeler * GIC, or for GICs without groups. 850c27a5ba9SFabian Aggeler */ 851c27a5ba9SFabian Aggeler if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) { 852c27a5ba9SFabian Aggeler /* Every byte offset holds 8 group status bits */ 853c27a5ba9SFabian Aggeler irq = (offset - 0x80) * 8 + GIC_BASE_IRQ; 854c27a5ba9SFabian Aggeler if (irq >= s->num_irq) { 855c27a5ba9SFabian Aggeler goto bad_reg; 856c27a5ba9SFabian Aggeler } 857c27a5ba9SFabian Aggeler for (i = 0; i < 8; i++) { 858c27a5ba9SFabian Aggeler /* Group bits are banked for private interrupts */ 859c27a5ba9SFabian Aggeler int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 860c27a5ba9SFabian Aggeler if (value & (1 << i)) { 861c27a5ba9SFabian Aggeler /* Group1 (Non-secure) */ 862c27a5ba9SFabian Aggeler GIC_SET_GROUP(irq + i, cm); 863c27a5ba9SFabian Aggeler } else { 864c27a5ba9SFabian Aggeler /* Group0 (Secure) */ 865c27a5ba9SFabian Aggeler GIC_CLEAR_GROUP(irq + i, cm); 866c27a5ba9SFabian Aggeler } 867c27a5ba9SFabian Aggeler } 868c27a5ba9SFabian Aggeler } 869e69954b9Spbrook } else { 870e69954b9Spbrook goto bad_reg; 871e69954b9Spbrook } 872e69954b9Spbrook } else if (offset < 0x180) { 873e69954b9Spbrook /* Interrupt Set Enable. */ 8749ee6e8bbSpbrook irq = (offset - 0x100) * 8 + GIC_BASE_IRQ; 875a32134aaSMark Langsdorf if (irq >= s->num_irq) 876e69954b9Spbrook goto bad_reg; 87741ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 8789ee6e8bbSpbrook value = 0xff; 87941ab7b55SChristoffer Dall } 88041ab7b55SChristoffer Dall 881e69954b9Spbrook for (i = 0; i < 8; i++) { 882e69954b9Spbrook if (value & (1 << i)) { 883f47b48fbSDaniel Sangorrin int mask = 884f47b48fbSDaniel Sangorrin (irq < GIC_INTERNAL) ? (1 << cpu) : GIC_TARGET(irq + i); 88569253800SRusty Russell int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 88641bf234dSRabin Vincent 887fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 888fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 889fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 890fea8a08eSJens Wiklander } 891fea8a08eSJens Wiklander 89241bf234dSRabin Vincent if (!GIC_TEST_ENABLED(irq + i, cm)) { 893e69954b9Spbrook DPRINTF("Enabled IRQ %d\n", irq + i); 8942531088fSHollis Blanchard trace_gic_enable_irq(irq + i); 89541bf234dSRabin Vincent } 89641bf234dSRabin Vincent GIC_SET_ENABLED(irq + i, cm); 897e69954b9Spbrook /* If a raised level triggered IRQ enabled then mark 898e69954b9Spbrook is as pending. */ 8999ee6e8bbSpbrook if (GIC_TEST_LEVEL(irq + i, mask) 90004050c5cSChristoffer Dall && !GIC_TEST_EDGE_TRIGGER(irq + i)) { 9019ee6e8bbSpbrook DPRINTF("Set %d pending mask %x\n", irq + i, mask); 9029ee6e8bbSpbrook GIC_SET_PENDING(irq + i, mask); 9039ee6e8bbSpbrook } 904e69954b9Spbrook } 905e69954b9Spbrook } 906e69954b9Spbrook } else if (offset < 0x200) { 907e69954b9Spbrook /* Interrupt Clear Enable. */ 9089ee6e8bbSpbrook irq = (offset - 0x180) * 8 + GIC_BASE_IRQ; 909a32134aaSMark Langsdorf if (irq >= s->num_irq) 910e69954b9Spbrook goto bad_reg; 91141ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 9129ee6e8bbSpbrook value = 0; 91341ab7b55SChristoffer Dall } 91441ab7b55SChristoffer Dall 915e69954b9Spbrook for (i = 0; i < 8; i++) { 916e69954b9Spbrook if (value & (1 << i)) { 91769253800SRusty Russell int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 91841bf234dSRabin Vincent 919fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 920fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 921fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 922fea8a08eSJens Wiklander } 923fea8a08eSJens Wiklander 92441bf234dSRabin Vincent if (GIC_TEST_ENABLED(irq + i, cm)) { 925e69954b9Spbrook DPRINTF("Disabled IRQ %d\n", irq + i); 9262531088fSHollis Blanchard trace_gic_disable_irq(irq + i); 92741bf234dSRabin Vincent } 92841bf234dSRabin Vincent GIC_CLEAR_ENABLED(irq + i, cm); 929e69954b9Spbrook } 930e69954b9Spbrook } 931e69954b9Spbrook } else if (offset < 0x280) { 932e69954b9Spbrook /* Interrupt Set Pending. */ 9339ee6e8bbSpbrook irq = (offset - 0x200) * 8 + GIC_BASE_IRQ; 934a32134aaSMark Langsdorf if (irq >= s->num_irq) 935e69954b9Spbrook goto bad_reg; 93641ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 9375b0adce1SChristoffer Dall value = 0; 93841ab7b55SChristoffer Dall } 9399ee6e8bbSpbrook 940e69954b9Spbrook for (i = 0; i < 8; i++) { 941e69954b9Spbrook if (value & (1 << i)) { 942fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 943fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 944fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 945fea8a08eSJens Wiklander } 946fea8a08eSJens Wiklander 947f47b48fbSDaniel Sangorrin GIC_SET_PENDING(irq + i, GIC_TARGET(irq + i)); 948e69954b9Spbrook } 949e69954b9Spbrook } 950e69954b9Spbrook } else if (offset < 0x300) { 951e69954b9Spbrook /* Interrupt Clear Pending. */ 9529ee6e8bbSpbrook irq = (offset - 0x280) * 8 + GIC_BASE_IRQ; 953a32134aaSMark Langsdorf if (irq >= s->num_irq) 954e69954b9Spbrook goto bad_reg; 9555b0adce1SChristoffer Dall if (irq < GIC_NR_SGIS) { 9565b0adce1SChristoffer Dall value = 0; 9575b0adce1SChristoffer Dall } 9585b0adce1SChristoffer Dall 959e69954b9Spbrook for (i = 0; i < 8; i++) { 960fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 961fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 962fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 963fea8a08eSJens Wiklander } 964fea8a08eSJens Wiklander 9659ee6e8bbSpbrook /* ??? This currently clears the pending bit for all CPUs, even 9669ee6e8bbSpbrook for per-CPU interrupts. It's unclear whether this is the 9679ee6e8bbSpbrook corect behavior. */ 968e69954b9Spbrook if (value & (1 << i)) { 9699ee6e8bbSpbrook GIC_CLEAR_PENDING(irq + i, ALL_CPU_MASK); 970e69954b9Spbrook } 971e69954b9Spbrook } 972e69954b9Spbrook } else if (offset < 0x400) { 973e69954b9Spbrook /* Interrupt Active. */ 974e69954b9Spbrook goto bad_reg; 975e69954b9Spbrook } else if (offset < 0x800) { 976e69954b9Spbrook /* Interrupt Priority. */ 9779ee6e8bbSpbrook irq = (offset - 0x400) + GIC_BASE_IRQ; 978a32134aaSMark Langsdorf if (irq >= s->num_irq) 979e69954b9Spbrook goto bad_reg; 98081508470SFabian Aggeler gic_set_priority(s, cpu, irq, value, attrs); 981e69954b9Spbrook } else if (offset < 0xc00) { 9826b9680bbSPeter Maydell /* Interrupt CPU Target. RAZ/WI on uniprocessor GICs, with the 9836b9680bbSPeter Maydell * annoying exception of the 11MPCore's GIC. 9846b9680bbSPeter Maydell */ 9856b9680bbSPeter Maydell if (s->num_cpu != 1 || s->revision == REV_11MPCORE) { 9869ee6e8bbSpbrook irq = (offset - 0x800) + GIC_BASE_IRQ; 9876b9680bbSPeter Maydell if (irq >= s->num_irq) { 988e69954b9Spbrook goto bad_reg; 9896b9680bbSPeter Maydell } 9906b9680bbSPeter Maydell if (irq < 29) { 9919ee6e8bbSpbrook value = 0; 9926b9680bbSPeter Maydell } else if (irq < GIC_INTERNAL) { 9939ee6e8bbSpbrook value = ALL_CPU_MASK; 9946b9680bbSPeter Maydell } 9959ee6e8bbSpbrook s->irq_target[irq] = value & ALL_CPU_MASK; 9966b9680bbSPeter Maydell } 997e69954b9Spbrook } else if (offset < 0xf00) { 998e69954b9Spbrook /* Interrupt Configuration. */ 9999ee6e8bbSpbrook irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ; 1000a32134aaSMark Langsdorf if (irq >= s->num_irq) 1001e69954b9Spbrook goto bad_reg; 1002de7a900fSAdam Lackorzynski if (irq < GIC_NR_SGIS) 10039ee6e8bbSpbrook value |= 0xaa; 1004e69954b9Spbrook for (i = 0; i < 4; i++) { 1005fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 1006fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 1007fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 1008fea8a08eSJens Wiklander } 1009fea8a08eSJens Wiklander 1010*7c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 1011e69954b9Spbrook if (value & (1 << (i * 2))) { 1012e69954b9Spbrook GIC_SET_MODEL(irq + i); 1013e69954b9Spbrook } else { 1014e69954b9Spbrook GIC_CLEAR_MODEL(irq + i); 1015e69954b9Spbrook } 101624b790dfSAdam Lackorzynski } 1017e69954b9Spbrook if (value & (2 << (i * 2))) { 101804050c5cSChristoffer Dall GIC_SET_EDGE_TRIGGER(irq + i); 1019e69954b9Spbrook } else { 102004050c5cSChristoffer Dall GIC_CLEAR_EDGE_TRIGGER(irq + i); 1021e69954b9Spbrook } 1022e69954b9Spbrook } 102340d22500SChristoffer Dall } else if (offset < 0xf10) { 10249ee6e8bbSpbrook /* 0xf00 is only handled for 32-bit writes. */ 1025e69954b9Spbrook goto bad_reg; 102640d22500SChristoffer Dall } else if (offset < 0xf20) { 102740d22500SChristoffer Dall /* GICD_CPENDSGIRn */ 1028*7c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 102940d22500SChristoffer Dall goto bad_reg; 103040d22500SChristoffer Dall } 103140d22500SChristoffer Dall irq = (offset - 0xf10); 103240d22500SChristoffer Dall 1033fea8a08eSJens Wiklander if (!s->security_extn || attrs.secure || 1034fea8a08eSJens Wiklander GIC_TEST_GROUP(irq, 1 << cpu)) { 103540d22500SChristoffer Dall s->sgi_pending[irq][cpu] &= ~value; 103640d22500SChristoffer Dall if (s->sgi_pending[irq][cpu] == 0) { 103740d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, 1 << cpu); 103840d22500SChristoffer Dall } 1039fea8a08eSJens Wiklander } 104040d22500SChristoffer Dall } else if (offset < 0xf30) { 104140d22500SChristoffer Dall /* GICD_SPENDSGIRn */ 1042*7c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 104340d22500SChristoffer Dall goto bad_reg; 104440d22500SChristoffer Dall } 104540d22500SChristoffer Dall irq = (offset - 0xf20); 104640d22500SChristoffer Dall 1047fea8a08eSJens Wiklander if (!s->security_extn || attrs.secure || 1048fea8a08eSJens Wiklander GIC_TEST_GROUP(irq, 1 << cpu)) { 104940d22500SChristoffer Dall GIC_SET_PENDING(irq, 1 << cpu); 105040d22500SChristoffer Dall s->sgi_pending[irq][cpu] |= value; 1051fea8a08eSJens Wiklander } 105240d22500SChristoffer Dall } else { 105340d22500SChristoffer Dall goto bad_reg; 1054e69954b9Spbrook } 1055e69954b9Spbrook gic_update(s); 1056e69954b9Spbrook return; 1057e69954b9Spbrook bad_reg: 10588c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 10598c8dc39fSPeter Maydell "gic_dist_writeb: Bad offset %x\n", (int)offset); 1060e69954b9Spbrook } 1061e69954b9Spbrook 1062a8170e5eSAvi Kivity static void gic_dist_writew(void *opaque, hwaddr offset, 1063a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1064e69954b9Spbrook { 1065a9d85353SPeter Maydell gic_dist_writeb(opaque, offset, value & 0xff, attrs); 1066a9d85353SPeter Maydell gic_dist_writeb(opaque, offset + 1, value >> 8, attrs); 1067e69954b9Spbrook } 1068e69954b9Spbrook 1069a8170e5eSAvi Kivity static void gic_dist_writel(void *opaque, hwaddr offset, 1070a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1071e69954b9Spbrook { 1072fae15286SPeter Maydell GICState *s = (GICState *)opaque; 10738da3ff18Spbrook if (offset == 0xf00) { 10749ee6e8bbSpbrook int cpu; 10759ee6e8bbSpbrook int irq; 10769ee6e8bbSpbrook int mask; 107740d22500SChristoffer Dall int target_cpu; 10789ee6e8bbSpbrook 1079926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 10809ee6e8bbSpbrook irq = value & 0x3ff; 10819ee6e8bbSpbrook switch ((value >> 24) & 3) { 10829ee6e8bbSpbrook case 0: 10839ee6e8bbSpbrook mask = (value >> 16) & ALL_CPU_MASK; 10849ee6e8bbSpbrook break; 10859ee6e8bbSpbrook case 1: 1086fa250144SAdam Lackorzynski mask = ALL_CPU_MASK ^ (1 << cpu); 10879ee6e8bbSpbrook break; 10889ee6e8bbSpbrook case 2: 1089fa250144SAdam Lackorzynski mask = 1 << cpu; 10909ee6e8bbSpbrook break; 10919ee6e8bbSpbrook default: 10929ee6e8bbSpbrook DPRINTF("Bad Soft Int target filter\n"); 10939ee6e8bbSpbrook mask = ALL_CPU_MASK; 10949ee6e8bbSpbrook break; 10959ee6e8bbSpbrook } 10969ee6e8bbSpbrook GIC_SET_PENDING(irq, mask); 109740d22500SChristoffer Dall target_cpu = ctz32(mask); 109840d22500SChristoffer Dall while (target_cpu < GIC_NCPU) { 109940d22500SChristoffer Dall s->sgi_pending[irq][target_cpu] |= (1 << cpu); 110040d22500SChristoffer Dall mask &= ~(1 << target_cpu); 110140d22500SChristoffer Dall target_cpu = ctz32(mask); 110240d22500SChristoffer Dall } 11039ee6e8bbSpbrook gic_update(s); 11049ee6e8bbSpbrook return; 11059ee6e8bbSpbrook } 1106a9d85353SPeter Maydell gic_dist_writew(opaque, offset, value & 0xffff, attrs); 1107a9d85353SPeter Maydell gic_dist_writew(opaque, offset + 2, value >> 16, attrs); 1108a9d85353SPeter Maydell } 1109a9d85353SPeter Maydell 1110a9d85353SPeter Maydell static MemTxResult gic_dist_write(void *opaque, hwaddr offset, uint64_t data, 1111a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1112a9d85353SPeter Maydell { 1113a9d85353SPeter Maydell switch (size) { 1114a9d85353SPeter Maydell case 1: 1115a9d85353SPeter Maydell gic_dist_writeb(opaque, offset, data, attrs); 1116a9d85353SPeter Maydell return MEMTX_OK; 1117a9d85353SPeter Maydell case 2: 1118a9d85353SPeter Maydell gic_dist_writew(opaque, offset, data, attrs); 1119a9d85353SPeter Maydell return MEMTX_OK; 1120a9d85353SPeter Maydell case 4: 1121a9d85353SPeter Maydell gic_dist_writel(opaque, offset, data, attrs); 1122a9d85353SPeter Maydell return MEMTX_OK; 1123a9d85353SPeter Maydell default: 1124a9d85353SPeter Maydell return MEMTX_ERROR; 1125a9d85353SPeter Maydell } 1126e69954b9Spbrook } 1127e69954b9Spbrook 112851fd06e0SPeter Maydell static inline uint32_t gic_apr_ns_view(GICState *s, int cpu, int regno) 112951fd06e0SPeter Maydell { 113051fd06e0SPeter Maydell /* Return the Nonsecure view of GICC_APR<regno>. This is the 113151fd06e0SPeter Maydell * second half of GICC_NSAPR. 113251fd06e0SPeter Maydell */ 113351fd06e0SPeter Maydell switch (GIC_MIN_BPR) { 113451fd06e0SPeter Maydell case 0: 113551fd06e0SPeter Maydell if (regno < 2) { 113651fd06e0SPeter Maydell return s->nsapr[regno + 2][cpu]; 113751fd06e0SPeter Maydell } 113851fd06e0SPeter Maydell break; 113951fd06e0SPeter Maydell case 1: 114051fd06e0SPeter Maydell if (regno == 0) { 114151fd06e0SPeter Maydell return s->nsapr[regno + 1][cpu]; 114251fd06e0SPeter Maydell } 114351fd06e0SPeter Maydell break; 114451fd06e0SPeter Maydell case 2: 114551fd06e0SPeter Maydell if (regno == 0) { 114651fd06e0SPeter Maydell return extract32(s->nsapr[0][cpu], 16, 16); 114751fd06e0SPeter Maydell } 114851fd06e0SPeter Maydell break; 114951fd06e0SPeter Maydell case 3: 115051fd06e0SPeter Maydell if (regno == 0) { 115151fd06e0SPeter Maydell return extract32(s->nsapr[0][cpu], 8, 8); 115251fd06e0SPeter Maydell } 115351fd06e0SPeter Maydell break; 115451fd06e0SPeter Maydell default: 115551fd06e0SPeter Maydell g_assert_not_reached(); 115651fd06e0SPeter Maydell } 115751fd06e0SPeter Maydell return 0; 115851fd06e0SPeter Maydell } 115951fd06e0SPeter Maydell 116051fd06e0SPeter Maydell static inline void gic_apr_write_ns_view(GICState *s, int cpu, int regno, 116151fd06e0SPeter Maydell uint32_t value) 116251fd06e0SPeter Maydell { 116351fd06e0SPeter Maydell /* Write the Nonsecure view of GICC_APR<regno>. */ 116451fd06e0SPeter Maydell switch (GIC_MIN_BPR) { 116551fd06e0SPeter Maydell case 0: 116651fd06e0SPeter Maydell if (regno < 2) { 116751fd06e0SPeter Maydell s->nsapr[regno + 2][cpu] = value; 116851fd06e0SPeter Maydell } 116951fd06e0SPeter Maydell break; 117051fd06e0SPeter Maydell case 1: 117151fd06e0SPeter Maydell if (regno == 0) { 117251fd06e0SPeter Maydell s->nsapr[regno + 1][cpu] = value; 117351fd06e0SPeter Maydell } 117451fd06e0SPeter Maydell break; 117551fd06e0SPeter Maydell case 2: 117651fd06e0SPeter Maydell if (regno == 0) { 117751fd06e0SPeter Maydell s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 16, 16, value); 117851fd06e0SPeter Maydell } 117951fd06e0SPeter Maydell break; 118051fd06e0SPeter Maydell case 3: 118151fd06e0SPeter Maydell if (regno == 0) { 118251fd06e0SPeter Maydell s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 8, 8, value); 118351fd06e0SPeter Maydell } 118451fd06e0SPeter Maydell break; 118551fd06e0SPeter Maydell default: 118651fd06e0SPeter Maydell g_assert_not_reached(); 118751fd06e0SPeter Maydell } 118851fd06e0SPeter Maydell } 118951fd06e0SPeter Maydell 1190a9d85353SPeter Maydell static MemTxResult gic_cpu_read(GICState *s, int cpu, int offset, 1191a9d85353SPeter Maydell uint64_t *data, MemTxAttrs attrs) 1192e69954b9Spbrook { 1193e69954b9Spbrook switch (offset) { 1194e69954b9Spbrook case 0x00: /* Control */ 119532951860SFabian Aggeler *data = gic_get_cpu_control(s, cpu, attrs); 1196a9d85353SPeter Maydell break; 1197e69954b9Spbrook case 0x04: /* Priority mask */ 119881508470SFabian Aggeler *data = gic_get_priority_mask(s, cpu, attrs); 1199a9d85353SPeter Maydell break; 1200e69954b9Spbrook case 0x08: /* Binary Point */ 1201822e9cc3SFabian Aggeler if (s->security_extn && !attrs.secure) { 1202822e9cc3SFabian Aggeler /* BPR is banked. Non-secure copy stored in ABPR. */ 1203822e9cc3SFabian Aggeler *data = s->abpr[cpu]; 1204822e9cc3SFabian Aggeler } else { 1205a9d85353SPeter Maydell *data = s->bpr[cpu]; 1206822e9cc3SFabian Aggeler } 1207a9d85353SPeter Maydell break; 1208e69954b9Spbrook case 0x0c: /* Acknowledge */ 1209c5619bf9SFabian Aggeler *data = gic_acknowledge_irq(s, cpu, attrs); 1210a9d85353SPeter Maydell break; 121166a0a2cbSDong Xu Wang case 0x14: /* Running Priority */ 121208efa9f2SFabian Aggeler *data = gic_get_running_priority(s, cpu, attrs); 1213a9d85353SPeter Maydell break; 1214e69954b9Spbrook case 0x18: /* Highest Pending Interrupt */ 12157c0fa108SFabian Aggeler *data = gic_get_current_pending_irq(s, cpu, attrs); 1216a9d85353SPeter Maydell break; 1217aa7d461aSChristoffer Dall case 0x1c: /* Aliased Binary Point */ 1218822e9cc3SFabian Aggeler /* GIC v2, no security: ABPR 1219822e9cc3SFabian Aggeler * GIC v1, no security: not implemented (RAZ/WI) 1220822e9cc3SFabian Aggeler * With security extensions, secure access: ABPR (alias of NS BPR) 1221822e9cc3SFabian Aggeler * With security extensions, nonsecure access: RAZ/WI 1222822e9cc3SFabian Aggeler */ 1223822e9cc3SFabian Aggeler if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 1224822e9cc3SFabian Aggeler *data = 0; 1225822e9cc3SFabian Aggeler } else { 1226a9d85353SPeter Maydell *data = s->abpr[cpu]; 1227822e9cc3SFabian Aggeler } 1228a9d85353SPeter Maydell break; 1229a9d477c4SChristoffer Dall case 0xd0: case 0xd4: case 0xd8: case 0xdc: 123051fd06e0SPeter Maydell { 123151fd06e0SPeter Maydell int regno = (offset - 0xd0) / 4; 123251fd06e0SPeter Maydell 123351fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 123451fd06e0SPeter Maydell *data = 0; 123551fd06e0SPeter Maydell } else if (s->security_extn && !attrs.secure) { 123651fd06e0SPeter Maydell /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */ 123751fd06e0SPeter Maydell *data = gic_apr_ns_view(s, regno, cpu); 123851fd06e0SPeter Maydell } else { 123951fd06e0SPeter Maydell *data = s->apr[regno][cpu]; 124051fd06e0SPeter Maydell } 1241a9d85353SPeter Maydell break; 124251fd06e0SPeter Maydell } 124351fd06e0SPeter Maydell case 0xe0: case 0xe4: case 0xe8: case 0xec: 124451fd06e0SPeter Maydell { 124551fd06e0SPeter Maydell int regno = (offset - 0xe0) / 4; 124651fd06e0SPeter Maydell 124751fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2 || !gic_has_groups(s) || 124851fd06e0SPeter Maydell (s->security_extn && !attrs.secure)) { 124951fd06e0SPeter Maydell *data = 0; 125051fd06e0SPeter Maydell } else { 125151fd06e0SPeter Maydell *data = s->nsapr[regno][cpu]; 125251fd06e0SPeter Maydell } 125351fd06e0SPeter Maydell break; 125451fd06e0SPeter Maydell } 1255e69954b9Spbrook default: 12568c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 12578c8dc39fSPeter Maydell "gic_cpu_read: Bad offset %x\n", (int)offset); 1258a9d85353SPeter Maydell return MEMTX_ERROR; 1259e69954b9Spbrook } 1260a9d85353SPeter Maydell return MEMTX_OK; 1261e69954b9Spbrook } 1262e69954b9Spbrook 1263a9d85353SPeter Maydell static MemTxResult gic_cpu_write(GICState *s, int cpu, int offset, 1264a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1265e69954b9Spbrook { 1266e69954b9Spbrook switch (offset) { 1267e69954b9Spbrook case 0x00: /* Control */ 126832951860SFabian Aggeler gic_set_cpu_control(s, cpu, value, attrs); 1269e69954b9Spbrook break; 1270e69954b9Spbrook case 0x04: /* Priority mask */ 127181508470SFabian Aggeler gic_set_priority_mask(s, cpu, value, attrs); 1272e69954b9Spbrook break; 1273e69954b9Spbrook case 0x08: /* Binary Point */ 1274822e9cc3SFabian Aggeler if (s->security_extn && !attrs.secure) { 1275822e9cc3SFabian Aggeler s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR); 1276822e9cc3SFabian Aggeler } else { 1277822e9cc3SFabian Aggeler s->bpr[cpu] = MAX(value & 0x7, GIC_MIN_BPR); 1278822e9cc3SFabian Aggeler } 1279e69954b9Spbrook break; 1280e69954b9Spbrook case 0x10: /* End Of Interrupt */ 1281f9c6a7f1SFabian Aggeler gic_complete_irq(s, cpu, value & 0x3ff, attrs); 1282a9d85353SPeter Maydell return MEMTX_OK; 1283aa7d461aSChristoffer Dall case 0x1c: /* Aliased Binary Point */ 1284822e9cc3SFabian Aggeler if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 1285822e9cc3SFabian Aggeler /* unimplemented, or NS access: RAZ/WI */ 1286822e9cc3SFabian Aggeler return MEMTX_OK; 1287822e9cc3SFabian Aggeler } else { 1288822e9cc3SFabian Aggeler s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR); 1289aa7d461aSChristoffer Dall } 1290aa7d461aSChristoffer Dall break; 1291a9d477c4SChristoffer Dall case 0xd0: case 0xd4: case 0xd8: case 0xdc: 129251fd06e0SPeter Maydell { 129351fd06e0SPeter Maydell int regno = (offset - 0xd0) / 4; 129451fd06e0SPeter Maydell 129551fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 129651fd06e0SPeter Maydell return MEMTX_OK; 129751fd06e0SPeter Maydell } 129851fd06e0SPeter Maydell if (s->security_extn && !attrs.secure) { 129951fd06e0SPeter Maydell /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */ 130051fd06e0SPeter Maydell gic_apr_write_ns_view(s, regno, cpu, value); 130151fd06e0SPeter Maydell } else { 130251fd06e0SPeter Maydell s->apr[regno][cpu] = value; 130351fd06e0SPeter Maydell } 1304a9d477c4SChristoffer Dall break; 130551fd06e0SPeter Maydell } 130651fd06e0SPeter Maydell case 0xe0: case 0xe4: case 0xe8: case 0xec: 130751fd06e0SPeter Maydell { 130851fd06e0SPeter Maydell int regno = (offset - 0xe0) / 4; 130951fd06e0SPeter Maydell 131051fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 131151fd06e0SPeter Maydell return MEMTX_OK; 131251fd06e0SPeter Maydell } 131351fd06e0SPeter Maydell if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 131451fd06e0SPeter Maydell return MEMTX_OK; 131551fd06e0SPeter Maydell } 131651fd06e0SPeter Maydell s->nsapr[regno][cpu] = value; 131751fd06e0SPeter Maydell break; 131851fd06e0SPeter Maydell } 1319a55c910eSPeter Maydell case 0x1000: 1320a55c910eSPeter Maydell /* GICC_DIR */ 1321a55c910eSPeter Maydell gic_deactivate_irq(s, cpu, value & 0x3ff, attrs); 1322a55c910eSPeter Maydell break; 1323e69954b9Spbrook default: 13248c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 13258c8dc39fSPeter Maydell "gic_cpu_write: Bad offset %x\n", (int)offset); 1326a9d85353SPeter Maydell return MEMTX_ERROR; 1327e69954b9Spbrook } 1328e69954b9Spbrook gic_update(s); 1329a9d85353SPeter Maydell return MEMTX_OK; 1330e69954b9Spbrook } 1331e2c56465SPeter Maydell 1332e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for the current CPU */ 1333a9d85353SPeter Maydell static MemTxResult gic_thiscpu_read(void *opaque, hwaddr addr, uint64_t *data, 1334a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1335e2c56465SPeter Maydell { 1336fae15286SPeter Maydell GICState *s = (GICState *)opaque; 1337a9d85353SPeter Maydell return gic_cpu_read(s, gic_get_current_cpu(s), addr, data, attrs); 1338e2c56465SPeter Maydell } 1339e2c56465SPeter Maydell 1340a9d85353SPeter Maydell static MemTxResult gic_thiscpu_write(void *opaque, hwaddr addr, 1341a9d85353SPeter Maydell uint64_t value, unsigned size, 1342a9d85353SPeter Maydell MemTxAttrs attrs) 1343e2c56465SPeter Maydell { 1344fae15286SPeter Maydell GICState *s = (GICState *)opaque; 1345a9d85353SPeter Maydell return gic_cpu_write(s, gic_get_current_cpu(s), addr, value, attrs); 1346e2c56465SPeter Maydell } 1347e2c56465SPeter Maydell 1348e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for a specific CPU. 1349fae15286SPeter Maydell * These just decode the opaque pointer into GICState* + cpu id. 1350e2c56465SPeter Maydell */ 1351a9d85353SPeter Maydell static MemTxResult gic_do_cpu_read(void *opaque, hwaddr addr, uint64_t *data, 1352a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1353e2c56465SPeter Maydell { 1354fae15286SPeter Maydell GICState **backref = (GICState **)opaque; 1355fae15286SPeter Maydell GICState *s = *backref; 1356e2c56465SPeter Maydell int id = (backref - s->backref); 1357a9d85353SPeter Maydell return gic_cpu_read(s, id, addr, data, attrs); 1358e2c56465SPeter Maydell } 1359e2c56465SPeter Maydell 1360a9d85353SPeter Maydell static MemTxResult gic_do_cpu_write(void *opaque, hwaddr addr, 1361a9d85353SPeter Maydell uint64_t value, unsigned size, 1362a9d85353SPeter Maydell MemTxAttrs attrs) 1363e2c56465SPeter Maydell { 1364fae15286SPeter Maydell GICState **backref = (GICState **)opaque; 1365fae15286SPeter Maydell GICState *s = *backref; 1366e2c56465SPeter Maydell int id = (backref - s->backref); 1367a9d85353SPeter Maydell return gic_cpu_write(s, id, addr, value, attrs); 1368e2c56465SPeter Maydell } 1369e2c56465SPeter Maydell 13707926c210SPavel Fedin static const MemoryRegionOps gic_ops[2] = { 13717926c210SPavel Fedin { 13727926c210SPavel Fedin .read_with_attrs = gic_dist_read, 13737926c210SPavel Fedin .write_with_attrs = gic_dist_write, 13747926c210SPavel Fedin .endianness = DEVICE_NATIVE_ENDIAN, 13757926c210SPavel Fedin }, 13767926c210SPavel Fedin { 1377a9d85353SPeter Maydell .read_with_attrs = gic_thiscpu_read, 1378a9d85353SPeter Maydell .write_with_attrs = gic_thiscpu_write, 1379e2c56465SPeter Maydell .endianness = DEVICE_NATIVE_ENDIAN, 13807926c210SPavel Fedin } 1381e2c56465SPeter Maydell }; 1382e2c56465SPeter Maydell 1383e2c56465SPeter Maydell static const MemoryRegionOps gic_cpu_ops = { 1384a9d85353SPeter Maydell .read_with_attrs = gic_do_cpu_read, 1385a9d85353SPeter Maydell .write_with_attrs = gic_do_cpu_write, 1386e2c56465SPeter Maydell .endianness = DEVICE_NATIVE_ENDIAN, 1387e2c56465SPeter Maydell }; 1388e69954b9Spbrook 13897926c210SPavel Fedin /* This function is used by nvic model */ 13907b95a508SKONRAD Frederic void gic_init_irqs_and_distributor(GICState *s) 1391e69954b9Spbrook { 13927926c210SPavel Fedin gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops); 13932b518c56SPeter Maydell } 13942b518c56SPeter Maydell 139553111180SPeter Maydell static void arm_gic_realize(DeviceState *dev, Error **errp) 13962b518c56SPeter Maydell { 139753111180SPeter Maydell /* Device instance realize function for the GIC sysbus device */ 13982b518c56SPeter Maydell int i; 139953111180SPeter Maydell GICState *s = ARM_GIC(dev); 140053111180SPeter Maydell SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 14011e8cae4dSPeter Maydell ARMGICClass *agc = ARM_GIC_GET_CLASS(s); 14020175ba10SMarkus Armbruster Error *local_err = NULL; 14031e8cae4dSPeter Maydell 14040175ba10SMarkus Armbruster agc->parent_realize(dev, &local_err); 14050175ba10SMarkus Armbruster if (local_err) { 14060175ba10SMarkus Armbruster error_propagate(errp, local_err); 140753111180SPeter Maydell return; 140853111180SPeter Maydell } 14091e8cae4dSPeter Maydell 14107926c210SPavel Fedin /* This creates distributor and main CPU interface (s->cpuiomem[0]) */ 14117926c210SPavel Fedin gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops); 14122b518c56SPeter Maydell 14137926c210SPavel Fedin /* Extra core-specific regions for the CPU interfaces. This is 14147926c210SPavel Fedin * necessary for "franken-GIC" implementations, for example on 14157926c210SPavel Fedin * Exynos 4. 1416e2c56465SPeter Maydell * NB that the memory region size of 0x100 applies for the 11MPCore 1417e2c56465SPeter Maydell * and also cores following the GIC v1 spec (ie A9). 1418e2c56465SPeter Maydell * GIC v2 defines a larger memory region (0x1000) so this will need 1419e2c56465SPeter Maydell * to be extended when we implement A15. 1420e2c56465SPeter Maydell */ 1421b95690c9SWei Huang for (i = 0; i < s->num_cpu; i++) { 1422e2c56465SPeter Maydell s->backref[i] = s; 14231437c94bSPaolo Bonzini memory_region_init_io(&s->cpuiomem[i+1], OBJECT(s), &gic_cpu_ops, 14241437c94bSPaolo Bonzini &s->backref[i], "gic_cpu", 0x100); 14257926c210SPavel Fedin sysbus_init_mmio(sbd, &s->cpuiomem[i+1]); 1426496dbcd1SPeter Maydell } 1427496dbcd1SPeter Maydell } 1428496dbcd1SPeter Maydell 1429496dbcd1SPeter Maydell static void arm_gic_class_init(ObjectClass *klass, void *data) 1430496dbcd1SPeter Maydell { 1431496dbcd1SPeter Maydell DeviceClass *dc = DEVICE_CLASS(klass); 14321e8cae4dSPeter Maydell ARMGICClass *agc = ARM_GIC_CLASS(klass); 143353111180SPeter Maydell 143453111180SPeter Maydell agc->parent_realize = dc->realize; 143553111180SPeter Maydell dc->realize = arm_gic_realize; 1436496dbcd1SPeter Maydell } 1437496dbcd1SPeter Maydell 14388c43a6f0SAndreas Färber static const TypeInfo arm_gic_info = { 14391e8cae4dSPeter Maydell .name = TYPE_ARM_GIC, 14401e8cae4dSPeter Maydell .parent = TYPE_ARM_GIC_COMMON, 1441fae15286SPeter Maydell .instance_size = sizeof(GICState), 1442496dbcd1SPeter Maydell .class_init = arm_gic_class_init, 1443998a74bcSPeter Maydell .class_size = sizeof(ARMGICClass), 1444496dbcd1SPeter Maydell }; 1445496dbcd1SPeter Maydell 1446496dbcd1SPeter Maydell static void arm_gic_register_types(void) 1447496dbcd1SPeter Maydell { 1448496dbcd1SPeter Maydell type_register_static(&arm_gic_info); 1449496dbcd1SPeter Maydell } 1450496dbcd1SPeter Maydell 1451496dbcd1SPeter Maydell type_init(arm_gic_register_types) 1452