arm_gic.c 45.6 KB
Newer Older
1
/*
P
pbrook 已提交
2
 * ARM Generic/Distributed Interrupt Controller
P
pbrook 已提交
3
 *
P
pbrook 已提交
4
 * Copyright (c) 2006-2007 CodeSourcery.
P
pbrook 已提交
5 6
 * Written by Paul Brook
 *
M
Matthew Fernandez 已提交
7
 * This code is licensed under the GPL.
P
pbrook 已提交
8 9
 */

P
pbrook 已提交
10
/* This file contains implementation code for the RealView EB interrupt
11 12 13 14 15 16 17 18 19
 * controller, MPCore distributed interrupt controller and ARMv7-M
 * Nested Vectored Interrupt Controller.
 * It is compiled in two ways:
 *  (1) as a standalone file to produce a sysbus device which is a GIC
 *  that can be used on the realview board and as one of the builtin
 *  private peripherals for the ARM MP CPUs (11MPCore, A9, etc)
 *  (2) by being directly #included into armv7m_nvic.c to produce the
 *  armv7m_nvic device.
 */
P
pbrook 已提交
20

P
Peter Maydell 已提交
21
#include "qemu/osdep.h"
22
#include "hw/sysbus.h"
23
#include "gic_internal.h"
24
#include "qapi/error.h"
25
#include "qom/cpu.h"
26
#include "qemu/log.h"
27
#include "trace.h"
28

29
/* #define DEBUG_GIC */
P
pbrook 已提交
30 31

#ifdef DEBUG_GIC
32
#define DEBUG_GIC_GATE 1
P
pbrook 已提交
33
#else
34
#define DEBUG_GIC_GATE 0
P
pbrook 已提交
35 36
#endif

37 38 39 40 41 42
#define DPRINTF(fmt, ...) do {                                          \
        if (DEBUG_GIC_GATE) {                                           \
            fprintf(stderr, "%s: " fmt, __func__, ## __VA_ARGS__);      \
        }                                                               \
    } while (0)

43 44 45 46 47 48 49 50 51 52
static const uint8_t gic_id_11mpcore[] = {
    0x00, 0x00, 0x00, 0x00, 0x90, 0x13, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1
};

static const uint8_t gic_id_gicv1[] = {
    0x04, 0x00, 0x00, 0x00, 0x90, 0xb3, 0x1b, 0x00, 0x0d, 0xf0, 0x05, 0xb1
};

static const uint8_t gic_id_gicv2[] = {
    0x04, 0x00, 0x00, 0x00, 0x90, 0xb4, 0x2b, 0x00, 0x0d, 0xf0, 0x05, 0xb1
53 54
};

55
static inline int gic_get_current_cpu(GICState *s)
56 57
{
    if (s->num_cpu > 1) {
58
        return current_cpu->cpu_index;
59 60 61 62
    }
    return 0;
}

63 64 65 66 67 68 69 70
/* Return true if this GIC config has interrupt groups, which is
 * true if we're a GICv2, or a GICv1 with the security extensions.
 */
static inline bool gic_has_groups(GICState *s)
{
    return s->revision == 2 || s->security_extn;
}

P
pbrook 已提交
71 72
/* TODO: Many places that call this routine could be optimized.  */
/* Update interrupt status after enabled or pending bits have been changed.  */
73
void gic_update(GICState *s)
P
pbrook 已提交
74 75 76 77
{
    int best_irq;
    int best_prio;
    int irq;
78
    int irq_level, fiq_level;
P
pbrook 已提交
79 80 81
    int cpu;
    int cm;

82
    for (cpu = 0; cpu < s->num_cpu; cpu++) {
P
pbrook 已提交
83 84
        cm = 1 << cpu;
        s->current_pending[cpu] = 1023;
85
        if (!(s->ctlr & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1))
86
            || !(s->cpu_ctlr[cpu] & (GICC_CTLR_EN_GRP0 | GICC_CTLR_EN_GRP1))) {
87
            qemu_irq_lower(s->parent_irq[cpu]);
88
            qemu_irq_lower(s->parent_fiq[cpu]);
89
            continue;
P
pbrook 已提交
90 91 92
        }
        best_prio = 0x100;
        best_irq = 1023;
93
        for (irq = 0; irq < s->num_irq; irq++) {
94 95
            if (GIC_TEST_ENABLED(irq, cm) && gic_test_pending(s, irq, cm) &&
                (irq < GIC_INTERNAL || GIC_TARGET(irq) & cm)) {
P
pbrook 已提交
96 97 98 99
                if (GIC_GET_PRIORITY(irq, cpu) < best_prio) {
                    best_prio = GIC_GET_PRIORITY(irq, cpu);
                    best_irq = irq;
                }
P
pbrook 已提交
100 101
            }
        }
102

103 104 105 106 107
        if (best_irq != 1023) {
            trace_gic_update_bestirq(cpu, best_irq, best_prio,
                s->priority_mask[cpu], s->running_priority[cpu]);
        }

108 109
        irq_level = fiq_level = 0;

110
        if (best_prio < s->priority_mask[cpu]) {
P
pbrook 已提交
111 112
            s->current_pending[cpu] = best_irq;
            if (best_prio < s->running_priority[cpu]) {
113 114 115 116 117 118 119 120
                int group = GIC_TEST_GROUP(best_irq, cm);

                if (extract32(s->ctlr, group, 1) &&
                    extract32(s->cpu_ctlr[cpu], group, 1)) {
                    if (group == 0 && s->cpu_ctlr[cpu] & GICC_CTLR_FIQ_EN) {
                        DPRINTF("Raised pending FIQ %d (cpu %d)\n",
                                best_irq, cpu);
                        fiq_level = 1;
121
                        trace_gic_update_set_irq(cpu, "fiq", fiq_level);
122 123 124 125
                    } else {
                        DPRINTF("Raised pending IRQ %d (cpu %d)\n",
                                best_irq, cpu);
                        irq_level = 1;
126
                        trace_gic_update_set_irq(cpu, "irq", irq_level);
127 128
                    }
                }
P
pbrook 已提交
129
            }
P
pbrook 已提交
130
        }
131 132 133

        qemu_set_irq(s->parent_irq[cpu], irq_level);
        qemu_set_irq(s->parent_fiq[cpu], fiq_level);
P
pbrook 已提交
134 135 136
    }
}

137
void gic_set_pending_private(GICState *s, int cpu, int irq)
P
pbrook 已提交
138 139 140
{
    int cm = 1 << cpu;

141
    if (gic_test_pending(s, irq, cm)) {
P
pbrook 已提交
142
        return;
143
    }
P
pbrook 已提交
144 145 146 147 148 149

    DPRINTF("Set %d pending cpu %d\n", irq, cpu);
    GIC_SET_PENDING(irq, cm);
    gic_update(s);
}

150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177
static void gic_set_irq_11mpcore(GICState *s, int irq, int level,
                                 int cm, int target)
{
    if (level) {
        GIC_SET_LEVEL(irq, cm);
        if (GIC_TEST_EDGE_TRIGGER(irq) || GIC_TEST_ENABLED(irq, cm)) {
            DPRINTF("Set %d pending mask %x\n", irq, target);
            GIC_SET_PENDING(irq, target);
        }
    } else {
        GIC_CLEAR_LEVEL(irq, cm);
    }
}

static void gic_set_irq_generic(GICState *s, int irq, int level,
                                int cm, int target)
{
    if (level) {
        GIC_SET_LEVEL(irq, cm);
        DPRINTF("Set %d pending mask %x\n", irq, target);
        if (GIC_TEST_EDGE_TRIGGER(irq)) {
            GIC_SET_PENDING(irq, target);
        }
    } else {
        GIC_CLEAR_LEVEL(irq, cm);
    }
}

P
pbrook 已提交
178
/* Process a change in an external IRQ input.  */
P
pbrook 已提交
179 180
static void gic_set_irq(void *opaque, int irq, int level)
{
181 182 183 184 185 186
    /* Meaning of the 'irq' parameter:
     *  [0..N-1] : external interrupts
     *  [N..N+31] : PPI (internal) interrupts for CPU 0
     *  [N+32..N+63] : PPI (internal interrupts for CPU 1
     *  ...
     */
187
    GICState *s = (GICState *)opaque;
188 189 190 191 192 193 194 195 196 197 198 199 200 201 202
    int cm, target;
    if (irq < (s->num_irq - GIC_INTERNAL)) {
        /* The first external input line is internal interrupt 32.  */
        cm = ALL_CPU_MASK;
        irq += GIC_INTERNAL;
        target = GIC_TARGET(irq);
    } else {
        int cpu;
        irq -= (s->num_irq - GIC_INTERNAL);
        cpu = irq / GIC_INTERNAL;
        irq %= GIC_INTERNAL;
        cm = 1 << cpu;
        target = cm;
    }

203 204
    assert(irq >= GIC_NR_SGIS);

205
    if (level == GIC_TEST_LEVEL(irq, cm)) {
P
pbrook 已提交
206
        return;
207
    }
P
pbrook 已提交
208

209
    if (s->revision == REV_11MPCORE) {
210
        gic_set_irq_11mpcore(s, irq, level, cm, target);
P
pbrook 已提交
211
    } else {
212
        gic_set_irq_generic(s, irq, level, cm, target);
P
pbrook 已提交
213
    }
214
    trace_gic_set_irq(irq, level, cm, target);
215

P
pbrook 已提交
216 217 218
    gic_update(s);
}

219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
static uint16_t gic_get_current_pending_irq(GICState *s, int cpu,
                                            MemTxAttrs attrs)
{
    uint16_t pending_irq = s->current_pending[cpu];

    if (pending_irq < GIC_MAXIRQ && gic_has_groups(s)) {
        int group = GIC_TEST_GROUP(pending_irq, (1 << cpu));
        /* On a GIC without the security extensions, reading this register
         * behaves in the same way as a secure access to a GIC with them.
         */
        bool secure = !s->security_extn || attrs.secure;

        if (group == 0 && !secure) {
            /* Group0 interrupts hidden from Non-secure access */
            return 1023;
        }
        if (group == 1 && secure && !(s->cpu_ctlr[cpu] & GICC_CTLR_ACK_CTL)) {
            /* Group1 interrupts only seen by Secure access if
             * AckCtl bit set.
             */
            return 1022;
        }
    }
    return pending_irq;
}

245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270
static int gic_get_group_priority(GICState *s, int cpu, int irq)
{
    /* Return the group priority of the specified interrupt
     * (which is the top bits of its priority, with the number
     * of bits masked determined by the applicable binary point register).
     */
    int bpr;
    uint32_t mask;

    if (gic_has_groups(s) &&
        !(s->cpu_ctlr[cpu] & GICC_CTLR_CBPR) &&
        GIC_TEST_GROUP(irq, (1 << cpu))) {
        bpr = s->abpr[cpu];
    } else {
        bpr = s->bpr[cpu];
    }

    /* a BPR of 0 means the group priority bits are [7:1];
     * a BPR of 1 means they are [7:2], and so on down to
     * a BPR of 7 meaning no group priority bits at all.
     */
    mask = ~0U << ((bpr & 7) + 1);

    return GIC_GET_PRIORITY(irq, cpu) & mask;
}

271
static void gic_activate_irq(GICState *s, int cpu, int irq)
P
pbrook 已提交
272
{
273 274 275 276 277 278 279 280 281
    /* Set the appropriate Active Priority Register bit for this IRQ,
     * and update the running priority.
     */
    int prio = gic_get_group_priority(s, cpu, irq);
    int preemption_level = prio >> (GIC_MIN_BPR + 1);
    int regno = preemption_level / 32;
    int bitno = preemption_level % 32;

    if (gic_has_groups(s) && GIC_TEST_GROUP(irq, (1 << cpu))) {
282
        s->nsapr[regno][cpu] |= (1 << bitno);
P
pbrook 已提交
283
    } else {
284
        s->apr[regno][cpu] |= (1 << bitno);
P
pbrook 已提交
285
    }
286 287

    s->running_priority[cpu] = prio;
288
    GIC_SET_ACTIVE(irq, 1 << cpu);
289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337
}

static int gic_get_prio_from_apr_bits(GICState *s, int cpu)
{
    /* Recalculate the current running priority for this CPU based
     * on the set bits in the Active Priority Registers.
     */
    int i;
    for (i = 0; i < GIC_NR_APRS; i++) {
        uint32_t apr = s->apr[i][cpu] | s->nsapr[i][cpu];
        if (!apr) {
            continue;
        }
        return (i * 32 + ctz32(apr)) << (GIC_MIN_BPR + 1);
    }
    return 0x100;
}

static void gic_drop_prio(GICState *s, int cpu, int group)
{
    /* Drop the priority of the currently active interrupt in the
     * specified group.
     *
     * Note that we can guarantee (because of the requirement to nest
     * GICC_IAR reads [which activate an interrupt and raise priority]
     * with GICC_EOIR writes [which drop the priority for the interrupt])
     * that the interrupt we're being called for is the highest priority
     * active interrupt, meaning that it has the lowest set bit in the
     * APR registers.
     *
     * If the guest does not honour the ordering constraints then the
     * behaviour of the GIC is UNPREDICTABLE, which for us means that
     * the values of the APR registers might become incorrect and the
     * running priority will be wrong, so interrupts that should preempt
     * might not do so, and interrupts that should not preempt might do so.
     */
    int i;

    for (i = 0; i < GIC_NR_APRS; i++) {
        uint32_t *papr = group ? &s->nsapr[i][cpu] : &s->apr[i][cpu];
        if (!*papr) {
            continue;
        }
        /* Clear lowest set bit */
        *papr &= *papr - 1;
        break;
    }

    s->running_priority[cpu] = gic_get_prio_from_apr_bits(s, cpu);
P
pbrook 已提交
338 339
}

340
uint32_t gic_acknowledge_irq(GICState *s, int cpu, MemTxAttrs attrs)
P
pbrook 已提交
341
{
342
    int ret, irq, src;
P
pbrook 已提交
343
    int cm = 1 << cpu;
344 345 346 347 348

    /* gic_get_current_pending_irq() will return 1022 or 1023 appropriately
     * for the case where this GIC supports grouping and the pending interrupt
     * is in the wrong group.
     */
349
    irq = gic_get_current_pending_irq(s, cpu, attrs);
350
    trace_gic_acknowledge_irq(cpu, irq);
351 352 353 354 355 356 357 358

    if (irq >= GIC_MAXIRQ) {
        DPRINTF("ACK, no pending interrupt or it is hidden: %d\n", irq);
        return irq;
    }

    if (GIC_GET_PRIORITY(irq, cpu) >= s->running_priority[cpu]) {
        DPRINTF("ACK, pending interrupt (%d) has insufficient priority\n", irq);
P
pbrook 已提交
359 360
        return 1023;
    }
361

362
    if (s->revision == REV_11MPCORE) {
363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390
        /* Clear pending flags for both level and edge triggered interrupts.
         * Level triggered IRQs will be reasserted once they become inactive.
         */
        GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm);
        ret = irq;
    } else {
        if (irq < GIC_NR_SGIS) {
            /* Lookup the source CPU for the SGI and clear this in the
             * sgi_pending map.  Return the src and clear the overall pending
             * state on this CPU if the SGI is not pending from any CPUs.
             */
            assert(s->sgi_pending[irq][cpu] != 0);
            src = ctz32(s->sgi_pending[irq][cpu]);
            s->sgi_pending[irq][cpu] &= ~(1 << src);
            if (s->sgi_pending[irq][cpu] == 0) {
                GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm);
            }
            ret = irq | ((src & 0x7) << 10);
        } else {
            /* Clear pending state for both level and edge triggered
             * interrupts. (level triggered interrupts with an active line
             * remain pending, see gic_test_pending)
             */
            GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm);
            ret = irq;
        }
    }

391 392
    gic_activate_irq(s, cpu, irq);
    gic_update(s);
393 394
    DPRINTF("ACK %d\n", irq);
    return ret;
P
pbrook 已提交
395 396
}

397 398
void gic_set_priority(GICState *s, int cpu, int irq, uint8_t val,
                      MemTxAttrs attrs)
399
{
400 401 402 403 404 405 406
    if (s->security_extn && !attrs.secure) {
        if (!GIC_TEST_GROUP(irq, (1 << cpu))) {
            return; /* Ignore Non-secure access of Group0 IRQ */
        }
        val = 0x80 | (val >> 1); /* Non-secure view */
    }

407 408 409 410 411 412 413
    if (irq < GIC_INTERNAL) {
        s->priority1[irq][cpu] = val;
    } else {
        s->priority2[(irq) - GIC_INTERNAL] = val;
    }
}

414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458
static uint32_t gic_get_priority(GICState *s, int cpu, int irq,
                                 MemTxAttrs attrs)
{
    uint32_t prio = GIC_GET_PRIORITY(irq, cpu);

    if (s->security_extn && !attrs.secure) {
        if (!GIC_TEST_GROUP(irq, (1 << cpu))) {
            return 0; /* Non-secure access cannot read priority of Group0 IRQ */
        }
        prio = (prio << 1) & 0xff; /* Non-secure view */
    }
    return prio;
}

static void gic_set_priority_mask(GICState *s, int cpu, uint8_t pmask,
                                  MemTxAttrs attrs)
{
    if (s->security_extn && !attrs.secure) {
        if (s->priority_mask[cpu] & 0x80) {
            /* Priority Mask in upper half */
            pmask = 0x80 | (pmask >> 1);
        } else {
            /* Non-secure write ignored if priority mask is in lower half */
            return;
        }
    }
    s->priority_mask[cpu] = pmask;
}

static uint32_t gic_get_priority_mask(GICState *s, int cpu, MemTxAttrs attrs)
{
    uint32_t pmask = s->priority_mask[cpu];

    if (s->security_extn && !attrs.secure) {
        if (pmask & 0x80) {
            /* Priority Mask in upper half, return Non-secure view */
            pmask = (pmask << 1) & 0xff;
        } else {
            /* Priority Mask in lower half, RAZ */
            pmask = 0;
        }
    }
    return pmask;
}

459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502
static uint32_t gic_get_cpu_control(GICState *s, int cpu, MemTxAttrs attrs)
{
    uint32_t ret = s->cpu_ctlr[cpu];

    if (s->security_extn && !attrs.secure) {
        /* Construct the NS banked view of GICC_CTLR from the correct
         * bits of the S banked view. We don't need to move the bypass
         * control bits because we don't implement that (IMPDEF) part
         * of the GIC architecture.
         */
        ret = (ret & (GICC_CTLR_EN_GRP1 | GICC_CTLR_EOIMODE_NS)) >> 1;
    }
    return ret;
}

static void gic_set_cpu_control(GICState *s, int cpu, uint32_t value,
                                MemTxAttrs attrs)
{
    uint32_t mask;

    if (s->security_extn && !attrs.secure) {
        /* The NS view can only write certain bits in the register;
         * the rest are unchanged
         */
        mask = GICC_CTLR_EN_GRP1;
        if (s->revision == 2) {
            mask |= GICC_CTLR_EOIMODE_NS;
        }
        s->cpu_ctlr[cpu] &= ~mask;
        s->cpu_ctlr[cpu] |= (value << 1) & mask;
    } else {
        if (s->revision == 2) {
            mask = s->security_extn ? GICC_CTLR_V2_S_MASK : GICC_CTLR_V2_MASK;
        } else {
            mask = s->security_extn ? GICC_CTLR_V1_S_MASK : GICC_CTLR_V1_MASK;
        }
        s->cpu_ctlr[cpu] = value & mask;
    }
    DPRINTF("CPU Interface %d: Group0 Interrupts %sabled, "
            "Group1 Interrupts %sabled\n", cpu,
            (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP0) ? "En" : "Dis",
            (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP1) ? "En" : "Dis");
}

503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519
static uint8_t gic_get_running_priority(GICState *s, int cpu, MemTxAttrs attrs)
{
    if (s->security_extn && !attrs.secure) {
        if (s->running_priority[cpu] & 0x80) {
            /* Running priority in upper half of range: return the Non-secure
             * view of the priority.
             */
            return s->running_priority[cpu] << 1;
        } else {
            /* Running priority in lower half of range: RAZ */
            return 0;
        }
    } else {
        return s->running_priority[cpu];
    }
}

520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554
/* Return true if we should split priority drop and interrupt deactivation,
 * ie whether the relevant EOIMode bit is set.
 */
static bool gic_eoi_split(GICState *s, int cpu, MemTxAttrs attrs)
{
    if (s->revision != 2) {
        /* Before GICv2 prio-drop and deactivate are not separable */
        return false;
    }
    if (s->security_extn && !attrs.secure) {
        return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE_NS;
    }
    return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE;
}

static void gic_deactivate_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs)
{
    int cm = 1 << cpu;
    int group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm);

    if (!gic_eoi_split(s, cpu, attrs)) {
        /* This is UNPREDICTABLE; we choose to ignore it */
        qemu_log_mask(LOG_GUEST_ERROR,
                      "gic_deactivate_irq: GICC_DIR write when EOIMode clear");
        return;
    }

    if (s->security_extn && !attrs.secure && !group) {
        DPRINTF("Non-secure DI for Group0 interrupt %d ignored\n", irq);
        return;
    }

    GIC_CLEAR_ACTIVE(irq, cm);
}

555
void gic_complete_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs)
P
pbrook 已提交
556
{
P
pbrook 已提交
557
    int cm = 1 << cpu;
558 559
    int group;

P
pbrook 已提交
560
    DPRINTF("EOI %d\n", irq);
561
    if (irq >= s->num_irq) {
562 563 564 565 566 567 568 569 570 571
        /* This handles two cases:
         * 1. If software writes the ID of a spurious interrupt [ie 1023]
         * to the GICC_EOIR, the GIC ignores that write.
         * 2. If software writes the number of a non-existent interrupt
         * this must be a subcase of "value written does not match the last
         * valid interrupt value read from the Interrupt Acknowledge
         * register" and so this is UNPREDICTABLE. We choose to ignore it.
         */
        return;
    }
572
    if (s->running_priority[cpu] == 0x100) {
P
pbrook 已提交
573
        return; /* No active IRQ.  */
574
    }
575

576
    if (s->revision == REV_11MPCORE) {
577 578 579 580 581 582 583
        /* Mark level triggered interrupts as pending if they are still
           raised.  */
        if (!GIC_TEST_EDGE_TRIGGER(irq) && GIC_TEST_ENABLED(irq, cm)
            && GIC_TEST_LEVEL(irq, cm) && (GIC_TARGET(irq) & cm) != 0) {
            DPRINTF("Set %d pending mask %x\n", irq, cm);
            GIC_SET_PENDING(irq, cm);
        }
P
pbrook 已提交
584
    }
585

586 587 588
    group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm);

    if (s->security_extn && !attrs.secure && !group) {
589 590 591 592 593 594 595 596 597
        DPRINTF("Non-secure EOI for Group0 interrupt %d ignored\n", irq);
        return;
    }

    /* Secure EOI with GICC_CTLR.AckCtl == 0 when the IRQ is a Group 1
     * interrupt is UNPREDICTABLE. We choose to handle it as if AckCtl == 1,
     * i.e. go ahead and complete the irq anyway.
     */

598
    gic_drop_prio(s, cpu, group);
599 600 601 602 603

    /* In GICv2 the guest can choose to split priority-drop and deactivate */
    if (!gic_eoi_split(s, cpu, attrs)) {
        GIC_CLEAR_ACTIVE(irq, cm);
    }
604
    gic_update(s);
P
pbrook 已提交
605 606
}

607
static uint32_t gic_dist_readb(void *opaque, hwaddr offset, MemTxAttrs attrs)
P
pbrook 已提交
608
{
609
    GICState *s = (GICState *)opaque;
P
pbrook 已提交
610 611 612
    uint32_t res;
    int irq;
    int i;
P
pbrook 已提交
613 614 615
    int cpu;
    int cm;
    int mask;
P
pbrook 已提交
616

617
    cpu = gic_get_current_cpu(s);
P
pbrook 已提交
618
    cm = 1 << cpu;
P
pbrook 已提交
619
    if (offset < 0x100) {
620 621 622 623 624 625 626 627 628 629
        if (offset == 0) {      /* GICD_CTLR */
            if (s->security_extn && !attrs.secure) {
                /* The NS bank of this register is just an alias of the
                 * EnableGrp1 bit in the S bank version.
                 */
                return extract32(s->ctlr, 1, 1);
            } else {
                return s->ctlr;
            }
        }
P
pbrook 已提交
630
        if (offset == 4)
631 632
            /* Interrupt Controller Type Register */
            return ((s->num_irq / 32) - 1)
633
                    | ((s->num_cpu - 1) << 5)
634
                    | (s->security_extn << 10);
P
pbrook 已提交
635 636
        if (offset < 0x08)
            return 0;
637
        if (offset >= 0x80) {
638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
            /* Interrupt Group Registers: these RAZ/WI if this is an NS
             * access to a GIC with the security extensions, or if the GIC
             * doesn't have groups at all.
             */
            res = 0;
            if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) {
                /* Every byte offset holds 8 group status bits */
                irq = (offset - 0x080) * 8 + GIC_BASE_IRQ;
                if (irq >= s->num_irq) {
                    goto bad_reg;
                }
                for (i = 0; i < 8; i++) {
                    if (GIC_TEST_GROUP(irq + i, cm)) {
                        res |= (1 << i);
                    }
                }
            }
            return res;
656
        }
P
pbrook 已提交
657 658 659 660 661 662 663
        goto bad_reg;
    } else if (offset < 0x200) {
        /* Interrupt Set/Clear Enable.  */
        if (offset < 0x180)
            irq = (offset - 0x100) * 8;
        else
            irq = (offset - 0x180) * 8;
P
pbrook 已提交
664
        irq += GIC_BASE_IRQ;
665
        if (irq >= s->num_irq)
P
pbrook 已提交
666 667 668
            goto bad_reg;
        res = 0;
        for (i = 0; i < 8; i++) {
669 670 671 672 673
            if (s->security_extn && !attrs.secure &&
                !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                continue; /* Ignore Non-secure access of Group0 IRQ */
            }

674
            if (GIC_TEST_ENABLED(irq + i, cm)) {
P
pbrook 已提交
675 676 677 678 679 680 681 682 683
                res |= (1 << i);
            }
        }
    } else if (offset < 0x300) {
        /* Interrupt Set/Clear Pending.  */
        if (offset < 0x280)
            irq = (offset - 0x200) * 8;
        else
            irq = (offset - 0x280) * 8;
P
pbrook 已提交
684
        irq += GIC_BASE_IRQ;
685
        if (irq >= s->num_irq)
P
pbrook 已提交
686 687
            goto bad_reg;
        res = 0;
R
Rusty Russell 已提交
688
        mask = (irq < GIC_INTERNAL) ?  cm : ALL_CPU_MASK;
P
pbrook 已提交
689
        for (i = 0; i < 8; i++) {
690 691 692 693 694
            if (s->security_extn && !attrs.secure &&
                !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                continue; /* Ignore Non-secure access of Group0 IRQ */
            }

695
            if (gic_test_pending(s, irq + i, mask)) {
P
pbrook 已提交
696 697 698 699 700
                res |= (1 << i);
            }
        }
    } else if (offset < 0x400) {
        /* Interrupt Active.  */
P
pbrook 已提交
701
        irq = (offset - 0x300) * 8 + GIC_BASE_IRQ;
702
        if (irq >= s->num_irq)
P
pbrook 已提交
703 704
            goto bad_reg;
        res = 0;
R
Rusty Russell 已提交
705
        mask = (irq < GIC_INTERNAL) ?  cm : ALL_CPU_MASK;
P
pbrook 已提交
706
        for (i = 0; i < 8; i++) {
707 708 709 710 711
            if (s->security_extn && !attrs.secure &&
                !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                continue; /* Ignore Non-secure access of Group0 IRQ */
            }

P
pbrook 已提交
712
            if (GIC_TEST_ACTIVE(irq + i, mask)) {
P
pbrook 已提交
713 714 715 716 717
                res |= (1 << i);
            }
        }
    } else if (offset < 0x800) {
        /* Interrupt Priority.  */
P
pbrook 已提交
718
        irq = (offset - 0x400) + GIC_BASE_IRQ;
719
        if (irq >= s->num_irq)
P
pbrook 已提交
720
            goto bad_reg;
721
        res = gic_get_priority(s, cpu, irq, attrs);
P
pbrook 已提交
722 723
    } else if (offset < 0xc00) {
        /* Interrupt CPU Target.  */
724 725 726
        if (s->num_cpu == 1 && s->revision != REV_11MPCORE) {
            /* For uniprocessor GICs these RAZ/WI */
            res = 0;
P
pbrook 已提交
727
        } else {
728 729 730 731 732 733 734 735 736
            irq = (offset - 0x800) + GIC_BASE_IRQ;
            if (irq >= s->num_irq) {
                goto bad_reg;
            }
            if (irq >= 29 && irq <= 31) {
                res = cm;
            } else {
                res = GIC_TARGET(irq);
            }
P
pbrook 已提交
737
        }
P
pbrook 已提交
738 739
    } else if (offset < 0xf00) {
        /* Interrupt Configuration.  */
740
        irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ;
741
        if (irq >= s->num_irq)
P
pbrook 已提交
742 743 744
            goto bad_reg;
        res = 0;
        for (i = 0; i < 4; i++) {
745 746 747 748 749
            if (s->security_extn && !attrs.secure &&
                !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                continue; /* Ignore Non-secure access of Group0 IRQ */
            }

P
pbrook 已提交
750 751
            if (GIC_TEST_MODEL(irq + i))
                res |= (1 << (i * 2));
752
            if (GIC_TEST_EDGE_TRIGGER(irq + i))
P
pbrook 已提交
753 754
                res |= (2 << (i * 2));
        }
755 756 757
    } else if (offset < 0xf10) {
        goto bad_reg;
    } else if (offset < 0xf30) {
758
        if (s->revision == REV_11MPCORE) {
759 760 761 762 763 764 765 766 767 768 769
            goto bad_reg;
        }

        if (offset < 0xf20) {
            /* GICD_CPENDSGIRn */
            irq = (offset - 0xf10);
        } else {
            irq = (offset - 0xf20);
            /* GICD_SPENDSGIRn */
        }

770 771 772 773 774 775
        if (s->security_extn && !attrs.secure &&
            !GIC_TEST_GROUP(irq, 1 << cpu)) {
            res = 0; /* Ignore Non-secure access of Group0 IRQ */
        } else {
            res = s->sgi_pending[irq][cpu];
        }
776
    } else if (offset < 0xfd0) {
P
pbrook 已提交
777
        goto bad_reg;
778
    } else if (offset < 0x1000) {
P
pbrook 已提交
779 780 781
        if (offset & 3) {
            res = 0;
        } else {
782 783 784 785 786 787 788 789 790 791 792 793 794
            switch (s->revision) {
            case REV_11MPCORE:
                res = gic_id_11mpcore[(offset - 0xfd0) >> 2];
                break;
            case 1:
                res = gic_id_gicv1[(offset - 0xfd0) >> 2];
                break;
            case 2:
                res = gic_id_gicv2[(offset - 0xfd0) >> 2];
                break;
            default:
                res = 0;
            }
P
pbrook 已提交
795
        }
796 797
    } else {
        g_assert_not_reached();
P
pbrook 已提交
798 799 800
    }
    return res;
bad_reg:
P
Peter Maydell 已提交
801 802
    qemu_log_mask(LOG_GUEST_ERROR,
                  "gic_dist_readb: Bad offset %x\n", (int)offset);
P
pbrook 已提交
803 804 805
    return 0;
}

806 807
static MemTxResult gic_dist_read(void *opaque, hwaddr offset, uint64_t *data,
                                 unsigned size, MemTxAttrs attrs)
P
pbrook 已提交
808
{
809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825
    switch (size) {
    case 1:
        *data = gic_dist_readb(opaque, offset, attrs);
        return MEMTX_OK;
    case 2:
        *data = gic_dist_readb(opaque, offset, attrs);
        *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8;
        return MEMTX_OK;
    case 4:
        *data = gic_dist_readb(opaque, offset, attrs);
        *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8;
        *data |= gic_dist_readb(opaque, offset + 2, attrs) << 16;
        *data |= gic_dist_readb(opaque, offset + 3, attrs) << 24;
        return MEMTX_OK;
    default:
        return MEMTX_ERROR;
    }
P
pbrook 已提交
826 827
}

A
Avi Kivity 已提交
828
static void gic_dist_writeb(void *opaque, hwaddr offset,
829
                            uint32_t value, MemTxAttrs attrs)
P
pbrook 已提交
830
{
831
    GICState *s = (GICState *)opaque;
P
pbrook 已提交
832 833
    int irq;
    int i;
P
pbrook 已提交
834
    int cpu;
P
pbrook 已提交
835

836
    cpu = gic_get_current_cpu(s);
P
pbrook 已提交
837 838
    if (offset < 0x100) {
        if (offset == 0) {
839 840 841 842 843 844 845 846 847 848 849
            if (s->security_extn && !attrs.secure) {
                /* NS version is just an alias of the S version's bit 1 */
                s->ctlr = deposit32(s->ctlr, 1, 1, value);
            } else if (gic_has_groups(s)) {
                s->ctlr = value & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1);
            } else {
                s->ctlr = value & GICD_CTLR_EN_GRP0;
            }
            DPRINTF("Distributor: Group0 %sabled; Group 1 %sabled\n",
                    s->ctlr & GICD_CTLR_EN_GRP0 ? "En" : "Dis",
                    s->ctlr & GICD_CTLR_EN_GRP1 ? "En" : "Dis");
P
pbrook 已提交
850 851
        } else if (offset < 4) {
            /* ignored.  */
852
        } else if (offset >= 0x80) {
853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873
            /* Interrupt Group Registers: RAZ/WI for NS access to secure
             * GIC, or for GICs without groups.
             */
            if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) {
                /* Every byte offset holds 8 group status bits */
                irq = (offset - 0x80) * 8 + GIC_BASE_IRQ;
                if (irq >= s->num_irq) {
                    goto bad_reg;
                }
                for (i = 0; i < 8; i++) {
                    /* Group bits are banked for private interrupts */
                    int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
                    if (value & (1 << i)) {
                        /* Group1 (Non-secure) */
                        GIC_SET_GROUP(irq + i, cm);
                    } else {
                        /* Group0 (Secure) */
                        GIC_CLEAR_GROUP(irq + i, cm);
                    }
                }
            }
P
pbrook 已提交
874 875 876 877 878
        } else {
            goto bad_reg;
        }
    } else if (offset < 0x180) {
        /* Interrupt Set Enable.  */
P
pbrook 已提交
879
        irq = (offset - 0x100) * 8 + GIC_BASE_IRQ;
880
        if (irq >= s->num_irq)
P
pbrook 已提交
881
            goto bad_reg;
882 883 884 885
        if (irq < GIC_NR_SGIS) {
            value = 0xff;
        }

P
pbrook 已提交
886 887
        for (i = 0; i < 8; i++) {
            if (value & (1 << i)) {
888 889
                int mask =
                    (irq < GIC_INTERNAL) ? (1 << cpu) : GIC_TARGET(irq + i);
R
Rusty Russell 已提交
890
                int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
891

892 893 894 895 896
                if (s->security_extn && !attrs.secure &&
                    !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                    continue; /* Ignore Non-secure access of Group0 IRQ */
                }

897
                if (!GIC_TEST_ENABLED(irq + i, cm)) {
P
pbrook 已提交
898
                    DPRINTF("Enabled IRQ %d\n", irq + i);
899
                    trace_gic_enable_irq(irq + i);
900 901
                }
                GIC_SET_ENABLED(irq + i, cm);
P
pbrook 已提交
902 903
                /* If a raised level triggered IRQ enabled then mark
                   is as pending.  */
P
pbrook 已提交
904
                if (GIC_TEST_LEVEL(irq + i, mask)
905
                        && !GIC_TEST_EDGE_TRIGGER(irq + i)) {
P
pbrook 已提交
906 907 908
                    DPRINTF("Set %d pending mask %x\n", irq + i, mask);
                    GIC_SET_PENDING(irq + i, mask);
                }
P
pbrook 已提交
909 910 911 912
            }
        }
    } else if (offset < 0x200) {
        /* Interrupt Clear Enable.  */
P
pbrook 已提交
913
        irq = (offset - 0x180) * 8 + GIC_BASE_IRQ;
914
        if (irq >= s->num_irq)
P
pbrook 已提交
915
            goto bad_reg;
916 917 918 919
        if (irq < GIC_NR_SGIS) {
            value = 0;
        }

P
pbrook 已提交
920 921
        for (i = 0; i < 8; i++) {
            if (value & (1 << i)) {
R
Rusty Russell 已提交
922
                int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
923

924 925 926 927 928
                if (s->security_extn && !attrs.secure &&
                    !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                    continue; /* Ignore Non-secure access of Group0 IRQ */
                }

929
                if (GIC_TEST_ENABLED(irq + i, cm)) {
P
pbrook 已提交
930
                    DPRINTF("Disabled IRQ %d\n", irq + i);
931
                    trace_gic_disable_irq(irq + i);
932 933
                }
                GIC_CLEAR_ENABLED(irq + i, cm);
P
pbrook 已提交
934 935 936 937
            }
        }
    } else if (offset < 0x280) {
        /* Interrupt Set Pending.  */
P
pbrook 已提交
938
        irq = (offset - 0x200) * 8 + GIC_BASE_IRQ;
939
        if (irq >= s->num_irq)
P
pbrook 已提交
940
            goto bad_reg;
941
        if (irq < GIC_NR_SGIS) {
942
            value = 0;
943
        }
P
pbrook 已提交
944

P
pbrook 已提交
945 946
        for (i = 0; i < 8; i++) {
            if (value & (1 << i)) {
947 948 949 950 951
                if (s->security_extn && !attrs.secure &&
                    !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                    continue; /* Ignore Non-secure access of Group0 IRQ */
                }

952
                GIC_SET_PENDING(irq + i, GIC_TARGET(irq + i));
P
pbrook 已提交
953 954 955 956
            }
        }
    } else if (offset < 0x300) {
        /* Interrupt Clear Pending.  */
P
pbrook 已提交
957
        irq = (offset - 0x280) * 8 + GIC_BASE_IRQ;
958
        if (irq >= s->num_irq)
P
pbrook 已提交
959
            goto bad_reg;
960 961 962 963
        if (irq < GIC_NR_SGIS) {
            value = 0;
        }

P
pbrook 已提交
964
        for (i = 0; i < 8; i++) {
965 966 967 968 969
            if (s->security_extn && !attrs.secure &&
                !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                continue; /* Ignore Non-secure access of Group0 IRQ */
            }

P
pbrook 已提交
970 971 972
            /* ??? This currently clears the pending bit for all CPUs, even
               for per-CPU interrupts.  It's unclear whether this is the
               corect behavior.  */
P
pbrook 已提交
973
            if (value & (1 << i)) {
P
pbrook 已提交
974
                GIC_CLEAR_PENDING(irq + i, ALL_CPU_MASK);
P
pbrook 已提交
975 976 977 978 979 980 981
            }
        }
    } else if (offset < 0x400) {
        /* Interrupt Active.  */
        goto bad_reg;
    } else if (offset < 0x800) {
        /* Interrupt Priority.  */
P
pbrook 已提交
982
        irq = (offset - 0x400) + GIC_BASE_IRQ;
983
        if (irq >= s->num_irq)
P
pbrook 已提交
984
            goto bad_reg;
985
        gic_set_priority(s, cpu, irq, value, attrs);
P
pbrook 已提交
986
    } else if (offset < 0xc00) {
987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001
        /* Interrupt CPU Target. RAZ/WI on uniprocessor GICs, with the
         * annoying exception of the 11MPCore's GIC.
         */
        if (s->num_cpu != 1 || s->revision == REV_11MPCORE) {
            irq = (offset - 0x800) + GIC_BASE_IRQ;
            if (irq >= s->num_irq) {
                goto bad_reg;
            }
            if (irq < 29) {
                value = 0;
            } else if (irq < GIC_INTERNAL) {
                value = ALL_CPU_MASK;
            }
            s->irq_target[irq] = value & ALL_CPU_MASK;
        }
P
pbrook 已提交
1002 1003
    } else if (offset < 0xf00) {
        /* Interrupt Configuration.  */
P
pbrook 已提交
1004
        irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ;
1005
        if (irq >= s->num_irq)
P
pbrook 已提交
1006
            goto bad_reg;
1007
        if (irq < GIC_NR_SGIS)
P
pbrook 已提交
1008
            value |= 0xaa;
P
pbrook 已提交
1009
        for (i = 0; i < 4; i++) {
1010 1011 1012 1013 1014
            if (s->security_extn && !attrs.secure &&
                !GIC_TEST_GROUP(irq + i, 1 << cpu)) {
                continue; /* Ignore Non-secure access of Group0 IRQ */
            }

1015
            if (s->revision == REV_11MPCORE) {
1016 1017 1018 1019 1020
                if (value & (1 << (i * 2))) {
                    GIC_SET_MODEL(irq + i);
                } else {
                    GIC_CLEAR_MODEL(irq + i);
                }
P
pbrook 已提交
1021 1022
            }
            if (value & (2 << (i * 2))) {
1023
                GIC_SET_EDGE_TRIGGER(irq + i);
P
pbrook 已提交
1024
            } else {
1025
                GIC_CLEAR_EDGE_TRIGGER(irq + i);
P
pbrook 已提交
1026 1027
            }
        }
1028
    } else if (offset < 0xf10) {
P
pbrook 已提交
1029
        /* 0xf00 is only handled for 32-bit writes.  */
P
pbrook 已提交
1030
        goto bad_reg;
1031 1032
    } else if (offset < 0xf20) {
        /* GICD_CPENDSGIRn */
1033
        if (s->revision == REV_11MPCORE) {
1034 1035 1036 1037
            goto bad_reg;
        }
        irq = (offset - 0xf10);

1038 1039 1040 1041 1042 1043
        if (!s->security_extn || attrs.secure ||
            GIC_TEST_GROUP(irq, 1 << cpu)) {
            s->sgi_pending[irq][cpu] &= ~value;
            if (s->sgi_pending[irq][cpu] == 0) {
                GIC_CLEAR_PENDING(irq, 1 << cpu);
            }
1044 1045 1046
        }
    } else if (offset < 0xf30) {
        /* GICD_SPENDSGIRn */
1047
        if (s->revision == REV_11MPCORE) {
1048 1049 1050 1051
            goto bad_reg;
        }
        irq = (offset - 0xf20);

1052 1053 1054 1055 1056
        if (!s->security_extn || attrs.secure ||
            GIC_TEST_GROUP(irq, 1 << cpu)) {
            GIC_SET_PENDING(irq, 1 << cpu);
            s->sgi_pending[irq][cpu] |= value;
        }
1057 1058
    } else {
        goto bad_reg;
P
pbrook 已提交
1059 1060 1061 1062
    }
    gic_update(s);
    return;
bad_reg:
P
Peter Maydell 已提交
1063 1064
    qemu_log_mask(LOG_GUEST_ERROR,
                  "gic_dist_writeb: Bad offset %x\n", (int)offset);
P
pbrook 已提交
1065 1066
}

A
Avi Kivity 已提交
1067
static void gic_dist_writew(void *opaque, hwaddr offset,
1068
                            uint32_t value, MemTxAttrs attrs)
P
pbrook 已提交
1069
{
1070 1071
    gic_dist_writeb(opaque, offset, value & 0xff, attrs);
    gic_dist_writeb(opaque, offset + 1, value >> 8, attrs);
P
pbrook 已提交
1072 1073
}

A
Avi Kivity 已提交
1074
static void gic_dist_writel(void *opaque, hwaddr offset,
1075
                            uint32_t value, MemTxAttrs attrs)
P
pbrook 已提交
1076
{
1077
    GICState *s = (GICState *)opaque;
1078
    if (offset == 0xf00) {
P
pbrook 已提交
1079 1080 1081
        int cpu;
        int irq;
        int mask;
1082
        int target_cpu;
P
pbrook 已提交
1083

1084
        cpu = gic_get_current_cpu(s);
P
pbrook 已提交
1085 1086 1087 1088 1089 1090
        irq = value & 0x3ff;
        switch ((value >> 24) & 3) {
        case 0:
            mask = (value >> 16) & ALL_CPU_MASK;
            break;
        case 1:
1091
            mask = ALL_CPU_MASK ^ (1 << cpu);
P
pbrook 已提交
1092 1093
            break;
        case 2:
1094
            mask = 1 << cpu;
P
pbrook 已提交
1095 1096 1097 1098 1099 1100 1101
            break;
        default:
            DPRINTF("Bad Soft Int target filter\n");
            mask = ALL_CPU_MASK;
            break;
        }
        GIC_SET_PENDING(irq, mask);
1102 1103 1104 1105 1106 1107
        target_cpu = ctz32(mask);
        while (target_cpu < GIC_NCPU) {
            s->sgi_pending[irq][target_cpu] |= (1 << cpu);
            mask &= ~(1 << target_cpu);
            target_cpu = ctz32(mask);
        }
P
pbrook 已提交
1108 1109 1110
        gic_update(s);
        return;
    }
1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130
    gic_dist_writew(opaque, offset, value & 0xffff, attrs);
    gic_dist_writew(opaque, offset + 2, value >> 16, attrs);
}

static MemTxResult gic_dist_write(void *opaque, hwaddr offset, uint64_t data,
                                  unsigned size, MemTxAttrs attrs)
{
    switch (size) {
    case 1:
        gic_dist_writeb(opaque, offset, data, attrs);
        return MEMTX_OK;
    case 2:
        gic_dist_writew(opaque, offset, data, attrs);
        return MEMTX_OK;
    case 4:
        gic_dist_writel(opaque, offset, data, attrs);
        return MEMTX_OK;
    default:
        return MEMTX_ERROR;
    }
P
pbrook 已提交
1131 1132
}

1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
static inline uint32_t gic_apr_ns_view(GICState *s, int cpu, int regno)
{
    /* Return the Nonsecure view of GICC_APR<regno>. This is the
     * second half of GICC_NSAPR.
     */
    switch (GIC_MIN_BPR) {
    case 0:
        if (regno < 2) {
            return s->nsapr[regno + 2][cpu];
        }
        break;
    case 1:
        if (regno == 0) {
            return s->nsapr[regno + 1][cpu];
        }
        break;
    case 2:
        if (regno == 0) {
            return extract32(s->nsapr[0][cpu], 16, 16);
        }
        break;
    case 3:
        if (regno == 0) {
            return extract32(s->nsapr[0][cpu], 8, 8);
        }
        break;
    default:
        g_assert_not_reached();
    }
    return 0;
}

static inline void gic_apr_write_ns_view(GICState *s, int cpu, int regno,
                                         uint32_t value)
{
    /* Write the Nonsecure view of GICC_APR<regno>. */
    switch (GIC_MIN_BPR) {
    case 0:
        if (regno < 2) {
            s->nsapr[regno + 2][cpu] = value;
        }
        break;
    case 1:
        if (regno == 0) {
            s->nsapr[regno + 1][cpu] = value;
        }
        break;
    case 2:
        if (regno == 0) {
            s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 16, 16, value);
        }
        break;
    case 3:
        if (regno == 0) {
            s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 8, 8, value);
        }
        break;
    default:
        g_assert_not_reached();
    }
}

1195 1196
static MemTxResult gic_cpu_read(GICState *s, int cpu, int offset,
                                uint64_t *data, MemTxAttrs attrs)
P
pbrook 已提交
1197 1198 1199
{
    switch (offset) {
    case 0x00: /* Control */
1200
        *data = gic_get_cpu_control(s, cpu, attrs);
1201
        break;
P
pbrook 已提交
1202
    case 0x04: /* Priority mask */
1203
        *data = gic_get_priority_mask(s, cpu, attrs);
1204
        break;
P
pbrook 已提交
1205
    case 0x08: /* Binary Point */
1206 1207 1208 1209 1210 1211
        if (s->security_extn && !attrs.secure) {
            /* BPR is banked. Non-secure copy stored in ABPR. */
            *data = s->abpr[cpu];
        } else {
            *data = s->bpr[cpu];
        }
1212
        break;
P
pbrook 已提交
1213
    case 0x0c: /* Acknowledge */
1214
        *data = gic_acknowledge_irq(s, cpu, attrs);
1215
        break;
D
Dong Xu Wang 已提交
1216
    case 0x14: /* Running Priority */
1217
        *data = gic_get_running_priority(s, cpu, attrs);
1218
        break;
P
pbrook 已提交
1219
    case 0x18: /* Highest Pending Interrupt */
1220
        *data = gic_get_current_pending_irq(s, cpu, attrs);
1221
        break;
1222
    case 0x1c: /* Aliased Binary Point */
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232
        /* GIC v2, no security: ABPR
         * GIC v1, no security: not implemented (RAZ/WI)
         * With security extensions, secure access: ABPR (alias of NS BPR)
         * With security extensions, nonsecure access: RAZ/WI
         */
        if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) {
            *data = 0;
        } else {
            *data = s->abpr[cpu];
        }
1233
        break;
1234
    case 0xd0: case 0xd4: case 0xd8: case 0xdc:
1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245
    {
        int regno = (offset - 0xd0) / 4;

        if (regno >= GIC_NR_APRS || s->revision != 2) {
            *data = 0;
        } else if (s->security_extn && !attrs.secure) {
            /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */
            *data = gic_apr_ns_view(s, regno, cpu);
        } else {
            *data = s->apr[regno][cpu];
        }
1246
        break;
1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259
    }
    case 0xe0: case 0xe4: case 0xe8: case 0xec:
    {
        int regno = (offset - 0xe0) / 4;

        if (regno >= GIC_NR_APRS || s->revision != 2 || !gic_has_groups(s) ||
            (s->security_extn && !attrs.secure)) {
            *data = 0;
        } else {
            *data = s->nsapr[regno][cpu];
        }
        break;
    }
P
pbrook 已提交
1260
    default:
P
Peter Maydell 已提交
1261 1262
        qemu_log_mask(LOG_GUEST_ERROR,
                      "gic_cpu_read: Bad offset %x\n", (int)offset);
1263
        return MEMTX_ERROR;
P
pbrook 已提交
1264
    }
1265
    return MEMTX_OK;
P
pbrook 已提交
1266 1267
}

1268 1269
static MemTxResult gic_cpu_write(GICState *s, int cpu, int offset,
                                 uint32_t value, MemTxAttrs attrs)
P
pbrook 已提交
1270 1271 1272
{
    switch (offset) {
    case 0x00: /* Control */
1273
        gic_set_cpu_control(s, cpu, value, attrs);
P
pbrook 已提交
1274 1275
        break;
    case 0x04: /* Priority mask */
1276
        gic_set_priority_mask(s, cpu, value, attrs);
P
pbrook 已提交
1277 1278
        break;
    case 0x08: /* Binary Point */
1279 1280 1281 1282 1283
        if (s->security_extn && !attrs.secure) {
            s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR);
        } else {
            s->bpr[cpu] = MAX(value & 0x7, GIC_MIN_BPR);
        }
P
pbrook 已提交
1284 1285
        break;
    case 0x10: /* End Of Interrupt */
1286
        gic_complete_irq(s, cpu, value & 0x3ff, attrs);
1287
        return MEMTX_OK;
1288
    case 0x1c: /* Aliased Binary Point */
1289 1290 1291 1292 1293
        if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) {
            /* unimplemented, or NS access: RAZ/WI */
            return MEMTX_OK;
        } else {
            s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR);
1294 1295
        }
        break;
1296
    case 0xd0: case 0xd4: case 0xd8: case 0xdc:
1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321
    {
        int regno = (offset - 0xd0) / 4;

        if (regno >= GIC_NR_APRS || s->revision != 2) {
            return MEMTX_OK;
        }
        if (s->security_extn && !attrs.secure) {
            /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */
            gic_apr_write_ns_view(s, regno, cpu, value);
        } else {
            s->apr[regno][cpu] = value;
        }
        break;
    }
    case 0xe0: case 0xe4: case 0xe8: case 0xec:
    {
        int regno = (offset - 0xe0) / 4;

        if (regno >= GIC_NR_APRS || s->revision != 2) {
            return MEMTX_OK;
        }
        if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) {
            return MEMTX_OK;
        }
        s->nsapr[regno][cpu] = value;
1322
        break;
1323
    }
1324 1325 1326 1327
    case 0x1000:
        /* GICC_DIR */
        gic_deactivate_irq(s, cpu, value & 0x3ff, attrs);
        break;
P
pbrook 已提交
1328
    default:
P
Peter Maydell 已提交
1329 1330
        qemu_log_mask(LOG_GUEST_ERROR,
                      "gic_cpu_write: Bad offset %x\n", (int)offset);
1331
        return MEMTX_ERROR;
P
pbrook 已提交
1332 1333
    }
    gic_update(s);
1334
    return MEMTX_OK;
P
pbrook 已提交
1335
}
1336 1337

/* Wrappers to read/write the GIC CPU interface for the current CPU */
1338 1339
static MemTxResult gic_thiscpu_read(void *opaque, hwaddr addr, uint64_t *data,
                                    unsigned size, MemTxAttrs attrs)
1340
{
1341
    GICState *s = (GICState *)opaque;
1342
    return gic_cpu_read(s, gic_get_current_cpu(s), addr, data, attrs);
1343 1344
}

1345 1346 1347
static MemTxResult gic_thiscpu_write(void *opaque, hwaddr addr,
                                     uint64_t value, unsigned size,
                                     MemTxAttrs attrs)
1348
{
1349
    GICState *s = (GICState *)opaque;
1350
    return gic_cpu_write(s, gic_get_current_cpu(s), addr, value, attrs);
1351 1352 1353
}

/* Wrappers to read/write the GIC CPU interface for a specific CPU.
1354
 * These just decode the opaque pointer into GICState* + cpu id.
1355
 */
1356 1357
static MemTxResult gic_do_cpu_read(void *opaque, hwaddr addr, uint64_t *data,
                                   unsigned size, MemTxAttrs attrs)
1358
{
1359 1360
    GICState **backref = (GICState **)opaque;
    GICState *s = *backref;
1361
    int id = (backref - s->backref);
1362
    return gic_cpu_read(s, id, addr, data, attrs);
1363 1364
}

1365 1366 1367
static MemTxResult gic_do_cpu_write(void *opaque, hwaddr addr,
                                    uint64_t value, unsigned size,
                                    MemTxAttrs attrs)
1368
{
1369 1370
    GICState **backref = (GICState **)opaque;
    GICState *s = *backref;
1371
    int id = (backref - s->backref);
1372
    return gic_cpu_write(s, id, addr, value, attrs);
1373 1374
}

P
Pavel Fedin 已提交
1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385
static const MemoryRegionOps gic_ops[2] = {
    {
        .read_with_attrs = gic_dist_read,
        .write_with_attrs = gic_dist_write,
        .endianness = DEVICE_NATIVE_ENDIAN,
    },
    {
        .read_with_attrs = gic_thiscpu_read,
        .write_with_attrs = gic_thiscpu_write,
        .endianness = DEVICE_NATIVE_ENDIAN,
    }
1386 1387 1388
};

static const MemoryRegionOps gic_cpu_ops = {
1389 1390
    .read_with_attrs = gic_do_cpu_read,
    .write_with_attrs = gic_do_cpu_write,
1391 1392
    .endianness = DEVICE_NATIVE_ENDIAN,
};
P
pbrook 已提交
1393

P
Pavel Fedin 已提交
1394
/* This function is used by nvic model */
1395
void gic_init_irqs_and_distributor(GICState *s)
P
pbrook 已提交
1396
{
P
Pavel Fedin 已提交
1397
    gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops);
1398 1399
}

1400
static void arm_gic_realize(DeviceState *dev, Error **errp)
1401
{
1402
    /* Device instance realize function for the GIC sysbus device */
1403
    int i;
1404 1405
    GICState *s = ARM_GIC(dev);
    SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
1406
    ARMGICClass *agc = ARM_GIC_GET_CLASS(s);
1407
    Error *local_err = NULL;
1408

1409 1410 1411
    agc->parent_realize(dev, &local_err);
    if (local_err) {
        error_propagate(errp, local_err);
1412 1413
        return;
    }
1414

P
Pavel Fedin 已提交
1415 1416
    /* This creates distributor and main CPU interface (s->cpuiomem[0]) */
    gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops);
1417

P
Pavel Fedin 已提交
1418 1419 1420
    /* Extra core-specific regions for the CPU interfaces. This is
     * necessary for "franken-GIC" implementations, for example on
     * Exynos 4.
1421 1422 1423 1424 1425
     * NB that the memory region size of 0x100 applies for the 11MPCore
     * and also cores following the GIC v1 spec (ie A9).
     * GIC v2 defines a larger memory region (0x1000) so this will need
     * to be extended when we implement A15.
     */
1426
    for (i = 0; i < s->num_cpu; i++) {
1427
        s->backref[i] = s;
1428 1429
        memory_region_init_io(&s->cpuiomem[i+1], OBJECT(s), &gic_cpu_ops,
                              &s->backref[i], "gic_cpu", 0x100);
P
Pavel Fedin 已提交
1430
        sysbus_init_mmio(sbd, &s->cpuiomem[i+1]);
1431 1432 1433 1434 1435 1436
    }
}

static void arm_gic_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
1437
    ARMGICClass *agc = ARM_GIC_CLASS(klass);
1438 1439 1440

    agc->parent_realize = dc->realize;
    dc->realize = arm_gic_realize;
1441 1442
}

1443
static const TypeInfo arm_gic_info = {
1444 1445
    .name = TYPE_ARM_GIC,
    .parent = TYPE_ARM_GIC_COMMON,
1446
    .instance_size = sizeof(GICState),
1447
    .class_init = arm_gic_class_init,
1448
    .class_size = sizeof(ARMGICClass),
1449 1450 1451 1452 1453 1454 1455 1456
};

static void arm_gic_register_types(void)
{
    type_register_static(&arm_gic_info);
}

type_init(arm_gic_register_types)