gic_v3.cc revision 13531
113531Sjairo.balart@metempsy.com/*
213531Sjairo.balart@metempsy.com * Copyright (c) 2018 Metempsy Technology Consulting
313531Sjairo.balart@metempsy.com * All rights reserved.
413531Sjairo.balart@metempsy.com *
513531Sjairo.balart@metempsy.com * Redistribution and use in source and binary forms, with or without
613531Sjairo.balart@metempsy.com * modification, are permitted provided that the following conditions are
713531Sjairo.balart@metempsy.com * met: redistributions of source code must retain the above copyright
813531Sjairo.balart@metempsy.com * notice, this list of conditions and the following disclaimer;
913531Sjairo.balart@metempsy.com * redistributions in binary form must reproduce the above copyright
1013531Sjairo.balart@metempsy.com * notice, this list of conditions and the following disclaimer in the
1113531Sjairo.balart@metempsy.com * documentation and/or other materials provided with the distribution;
1213531Sjairo.balart@metempsy.com * neither the name of the copyright holders nor the names of its
1313531Sjairo.balart@metempsy.com * contributors may be used to endorse or promote products derived from
1413531Sjairo.balart@metempsy.com * this software without specific prior written permission.
1513531Sjairo.balart@metempsy.com *
1613531Sjairo.balart@metempsy.com * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
1713531Sjairo.balart@metempsy.com * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
1813531Sjairo.balart@metempsy.com * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
1913531Sjairo.balart@metempsy.com * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
2013531Sjairo.balart@metempsy.com * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
2113531Sjairo.balart@metempsy.com * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
2213531Sjairo.balart@metempsy.com * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
2313531Sjairo.balart@metempsy.com * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
2413531Sjairo.balart@metempsy.com * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
2513531Sjairo.balart@metempsy.com * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
2613531Sjairo.balart@metempsy.com * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2713531Sjairo.balart@metempsy.com *
2813531Sjairo.balart@metempsy.com * Authors: Jairo Balart
2913531Sjairo.balart@metempsy.com */
3013531Sjairo.balart@metempsy.com
3113531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3.hh"
3213531Sjairo.balart@metempsy.com
3313531Sjairo.balart@metempsy.com#include "cpu/intr_control.hh"
3413531Sjairo.balart@metempsy.com#include "debug/GIC.hh"
3513531Sjairo.balart@metempsy.com#include "debug/Interrupt.hh"
3613531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3_cpu_interface.hh"
3713531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3_distributor.hh"
3813531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3_redistributor.hh"
3913531Sjairo.balart@metempsy.com#include "dev/platform.hh"
4013531Sjairo.balart@metempsy.com#include "mem/packet.hh"
4113531Sjairo.balart@metempsy.com#include "mem/packet_access.hh"
4213531Sjairo.balart@metempsy.com
4313531Sjairo.balart@metempsy.comGicv3::Gicv3(const Params * p)
4413531Sjairo.balart@metempsy.com    : BaseGic(p)
4513531Sjairo.balart@metempsy.com{
4613531Sjairo.balart@metempsy.com}
4713531Sjairo.balart@metempsy.com
4813531Sjairo.balart@metempsy.comGicv3::~Gicv3()
4913531Sjairo.balart@metempsy.com{
5013531Sjairo.balart@metempsy.com}
5113531Sjairo.balart@metempsy.com
5213531Sjairo.balart@metempsy.comvoid
5313531Sjairo.balart@metempsy.comGicv3::init()
5413531Sjairo.balart@metempsy.com{
5513531Sjairo.balart@metempsy.com    distRange = RangeSize(params()->dist_addr,
5613531Sjairo.balart@metempsy.com                          Gicv3Distributor::ADDR_RANGE_SIZE - 1);
5713531Sjairo.balart@metempsy.com    redistRange = RangeSize(params()->redist_addr,
5813531Sjairo.balart@metempsy.com        Gicv3Redistributor::ADDR_RANGE_SIZE * sys->numContexts() - 1);
5913531Sjairo.balart@metempsy.com    addrRanges = {distRange, redistRange};
6013531Sjairo.balart@metempsy.com    BaseGic::init();
6113531Sjairo.balart@metempsy.com    distributor = new Gicv3Distributor(this, params()->it_lines);
6213531Sjairo.balart@metempsy.com    redistributors.resize(sys->numContexts(), nullptr);
6313531Sjairo.balart@metempsy.com    cpuInterfaces.resize(sys->numContexts(), nullptr);
6413531Sjairo.balart@metempsy.com
6513531Sjairo.balart@metempsy.com    for (int i = 0; i < sys->numContexts(); i++) {
6613531Sjairo.balart@metempsy.com        redistributors[i] = new Gicv3Redistributor(this, i);
6713531Sjairo.balart@metempsy.com        cpuInterfaces[i] = new Gicv3CPUInterface(this, i);
6813531Sjairo.balart@metempsy.com    }
6913531Sjairo.balart@metempsy.com
7013531Sjairo.balart@metempsy.com    distributor->init();
7113531Sjairo.balart@metempsy.com
7213531Sjairo.balart@metempsy.com    for (int i = 0; i < sys->numContexts(); i++) {
7313531Sjairo.balart@metempsy.com        redistributors[i]->init();
7413531Sjairo.balart@metempsy.com        cpuInterfaces[i]->init();
7513531Sjairo.balart@metempsy.com    }
7613531Sjairo.balart@metempsy.com}
7713531Sjairo.balart@metempsy.com
7813531Sjairo.balart@metempsy.comvoid
7913531Sjairo.balart@metempsy.comGicv3::initState()
8013531Sjairo.balart@metempsy.com{
8113531Sjairo.balart@metempsy.com    distributor->initState();
8213531Sjairo.balart@metempsy.com
8313531Sjairo.balart@metempsy.com    for (int i = 0; i < sys->numContexts(); i++) {
8413531Sjairo.balart@metempsy.com        redistributors[i]->initState();
8513531Sjairo.balart@metempsy.com        cpuInterfaces[i]->initState();
8613531Sjairo.balart@metempsy.com    }
8713531Sjairo.balart@metempsy.com}
8813531Sjairo.balart@metempsy.com
8913531Sjairo.balart@metempsy.comTick
9013531Sjairo.balart@metempsy.comGicv3::read(PacketPtr pkt)
9113531Sjairo.balart@metempsy.com{
9213531Sjairo.balart@metempsy.com    const Addr addr = pkt->getAddr();
9313531Sjairo.balart@metempsy.com    const size_t size = pkt->getSize();
9413531Sjairo.balart@metempsy.com    const ContextID context_id = pkt->req->contextId();
9513531Sjairo.balart@metempsy.com    bool is_secure_access = pkt->isSecure();
9613531Sjairo.balart@metempsy.com    uint64_t resp = 0;
9713531Sjairo.balart@metempsy.com    Tick delay = 0;
9813531Sjairo.balart@metempsy.com
9913531Sjairo.balart@metempsy.com    if (distRange.contains(addr)) {
10013531Sjairo.balart@metempsy.com        const Addr daddr = addr - distRange.start();
10113531Sjairo.balart@metempsy.com        panic_if(!distributor, "Distributor is null!");
10213531Sjairo.balart@metempsy.com        resp = distributor->read(daddr, size, is_secure_access);
10313531Sjairo.balart@metempsy.com        delay = params()->dist_pio_delay;
10413531Sjairo.balart@metempsy.com        DPRINTF(GIC, "Gicv3::read(): (distributor) context_id %d register %#x "
10513531Sjairo.balart@metempsy.com                "size %d is_secure_access %d (value %#x)\n",
10613531Sjairo.balart@metempsy.com                context_id, daddr, size, is_secure_access, resp);
10713531Sjairo.balart@metempsy.com    } else if (redistRange.contains(addr)) {
10813531Sjairo.balart@metempsy.com        Addr daddr = addr - redistRange.start();
10913531Sjairo.balart@metempsy.com        uint32_t redistributor_id =
11013531Sjairo.balart@metempsy.com            daddr / Gicv3Redistributor::ADDR_RANGE_SIZE;
11113531Sjairo.balart@metempsy.com        daddr = daddr % Gicv3Redistributor::ADDR_RANGE_SIZE;
11213531Sjairo.balart@metempsy.com        panic_if(redistributor_id >= redistributors.size(),
11313531Sjairo.balart@metempsy.com                 "Invalid redistributor_id!");
11413531Sjairo.balart@metempsy.com        panic_if(!redistributors[redistributor_id], "Redistributor is null!");
11513531Sjairo.balart@metempsy.com        resp = redistributors[redistributor_id]->read(daddr, size,
11613531Sjairo.balart@metempsy.com                is_secure_access);
11713531Sjairo.balart@metempsy.com        delay = params()->redist_pio_delay;
11813531Sjairo.balart@metempsy.com        DPRINTF(GIC, "Gicv3::read(): (redistributor %d) context_id %d "
11913531Sjairo.balart@metempsy.com                "register %#x size %d is_secure_access %d (value %#x)\n",
12013531Sjairo.balart@metempsy.com                redistributor_id, context_id, daddr, size, is_secure_access,
12113531Sjairo.balart@metempsy.com                resp);
12213531Sjairo.balart@metempsy.com    } else {
12313531Sjairo.balart@metempsy.com        panic("Gicv3::read(): unknown address %#x\n", addr);
12413531Sjairo.balart@metempsy.com    }
12513531Sjairo.balart@metempsy.com
12613531Sjairo.balart@metempsy.com    pkt->setUintX(resp, LittleEndianByteOrder);
12713531Sjairo.balart@metempsy.com    pkt->makeAtomicResponse();
12813531Sjairo.balart@metempsy.com    return delay;
12913531Sjairo.balart@metempsy.com}
13013531Sjairo.balart@metempsy.com
13113531Sjairo.balart@metempsy.comTick
13213531Sjairo.balart@metempsy.comGicv3::write(PacketPtr pkt)
13313531Sjairo.balart@metempsy.com{
13413531Sjairo.balart@metempsy.com    const size_t size = pkt->getSize();
13513531Sjairo.balart@metempsy.com    uint64_t data = pkt->getUintX(LittleEndianByteOrder);
13613531Sjairo.balart@metempsy.com    const Addr addr = pkt->getAddr();
13713531Sjairo.balart@metempsy.com    const ContextID context_id = pkt->req->contextId();
13813531Sjairo.balart@metempsy.com    bool is_secure_access = pkt->isSecure();
13913531Sjairo.balart@metempsy.com    Tick delay = 0;
14013531Sjairo.balart@metempsy.com
14113531Sjairo.balart@metempsy.com    if (distRange.contains(addr)) {
14213531Sjairo.balart@metempsy.com        const Addr daddr = addr - distRange.start();
14313531Sjairo.balart@metempsy.com        panic_if(!distributor, "Distributor is null!");
14413531Sjairo.balart@metempsy.com        DPRINTF(GIC, "Gicv3::write(): (distributor) context_id %d "
14513531Sjairo.balart@metempsy.com                "register %#x size %d is_secure_access %d value %#x\n",
14613531Sjairo.balart@metempsy.com                context_id, daddr, size, is_secure_access, data);
14713531Sjairo.balart@metempsy.com        distributor->write(daddr, data, size, is_secure_access);
14813531Sjairo.balart@metempsy.com        delay = params()->dist_pio_delay;
14913531Sjairo.balart@metempsy.com    } else if (redistRange.contains(addr)) {
15013531Sjairo.balart@metempsy.com        Addr daddr = addr - redistRange.start();
15113531Sjairo.balart@metempsy.com        uint32_t redistributor_id =
15213531Sjairo.balart@metempsy.com            daddr / Gicv3Redistributor::ADDR_RANGE_SIZE;
15313531Sjairo.balart@metempsy.com        daddr = daddr % Gicv3Redistributor::ADDR_RANGE_SIZE;
15413531Sjairo.balart@metempsy.com        panic_if(redistributor_id >= redistributors.size(),
15513531Sjairo.balart@metempsy.com                 "Invalid redistributor_id!");
15613531Sjairo.balart@metempsy.com        panic_if(!redistributors[redistributor_id], "Redistributor is null!");
15713531Sjairo.balart@metempsy.com        DPRINTF(GIC, "Gicv3::write(): (redistributor %d) context_id %d "
15813531Sjairo.balart@metempsy.com                "register %#x size %d is_secure_access %d value %#x\n",
15913531Sjairo.balart@metempsy.com                redistributor_id, context_id, daddr, size, is_secure_access,
16013531Sjairo.balart@metempsy.com                data);
16113531Sjairo.balart@metempsy.com        redistributors[redistributor_id]->write(daddr, data, size,
16213531Sjairo.balart@metempsy.com                                                is_secure_access);
16313531Sjairo.balart@metempsy.com        delay = params()->redist_pio_delay;
16413531Sjairo.balart@metempsy.com    } else {
16513531Sjairo.balart@metempsy.com        panic("Gicv3::write(): unknown address %#x\n", addr);
16613531Sjairo.balart@metempsy.com    }
16713531Sjairo.balart@metempsy.com
16813531Sjairo.balart@metempsy.com    pkt->makeAtomicResponse();
16913531Sjairo.balart@metempsy.com    return delay;
17013531Sjairo.balart@metempsy.com}
17113531Sjairo.balart@metempsy.com
17213531Sjairo.balart@metempsy.comvoid
17313531Sjairo.balart@metempsy.comGicv3::sendInt(uint32_t int_id)
17413531Sjairo.balart@metempsy.com{
17513531Sjairo.balart@metempsy.com    panic_if(int_id < Gicv3::SGI_MAX + Gicv3::PPI_MAX, "Invalid SPI!");
17613531Sjairo.balart@metempsy.com    panic_if(int_id >= Gicv3::INTID_SECURE, "Invalid SPI!");
17713531Sjairo.balart@metempsy.com    DPRINTF(Interrupt, "Gicv3::sendInt(): received SPI %d\n", int_id);
17813531Sjairo.balart@metempsy.com    distributor->sendInt(int_id);
17913531Sjairo.balart@metempsy.com}
18013531Sjairo.balart@metempsy.com
18113531Sjairo.balart@metempsy.comvoid
18213531Sjairo.balart@metempsy.comGicv3::clearInt(uint32_t number)
18313531Sjairo.balart@metempsy.com{
18413531Sjairo.balart@metempsy.com    distributor->intDeasserted(number);
18513531Sjairo.balart@metempsy.com}
18613531Sjairo.balart@metempsy.com
18713531Sjairo.balart@metempsy.comvoid
18813531Sjairo.balart@metempsy.comGicv3::sendPPInt(uint32_t int_id, uint32_t cpu)
18913531Sjairo.balart@metempsy.com{
19013531Sjairo.balart@metempsy.com    panic_if(cpu >= redistributors.size(), "Invalid cpuID sending PPI!");
19113531Sjairo.balart@metempsy.com    panic_if(int_id < Gicv3::SGI_MAX, "Invalid PPI!");
19213531Sjairo.balart@metempsy.com    panic_if(int_id >= Gicv3::SGI_MAX + Gicv3::PPI_MAX, "Invalid PPI!");
19313531Sjairo.balart@metempsy.com    DPRINTF(Interrupt, "Gicv3::sendPPInt(): received PPI %d cpuTarget %#x\n",
19413531Sjairo.balart@metempsy.com            int_id, cpu);
19513531Sjairo.balart@metempsy.com    redistributors[cpu]->sendPPInt(int_id);
19613531Sjairo.balart@metempsy.com}
19713531Sjairo.balart@metempsy.com
19813531Sjairo.balart@metempsy.comvoid
19913531Sjairo.balart@metempsy.comGicv3::clearPPInt(uint32_t num, uint32_t cpu)
20013531Sjairo.balart@metempsy.com{
20113531Sjairo.balart@metempsy.com}
20213531Sjairo.balart@metempsy.com
20313531Sjairo.balart@metempsy.comvoid
20413531Sjairo.balart@metempsy.comGicv3::postInt(uint32_t cpu, ArmISA::InterruptTypes int_type)
20513531Sjairo.balart@metempsy.com{
20613531Sjairo.balart@metempsy.com    postDelayedInt(cpu, int_type);
20713531Sjairo.balart@metempsy.com}
20813531Sjairo.balart@metempsy.com
20913531Sjairo.balart@metempsy.comvoid
21013531Sjairo.balart@metempsy.comGicv3::deassertInt(uint32_t cpu, ArmISA::InterruptTypes int_type)
21113531Sjairo.balart@metempsy.com{
21213531Sjairo.balart@metempsy.com    platform->intrctrl->clear(cpu, int_type, 0);
21313531Sjairo.balart@metempsy.com}
21413531Sjairo.balart@metempsy.com
21513531Sjairo.balart@metempsy.comvoid
21613531Sjairo.balart@metempsy.comGicv3::postDelayedInt(uint32_t cpu, ArmISA::InterruptTypes int_type)
21713531Sjairo.balart@metempsy.com{
21813531Sjairo.balart@metempsy.com    platform->intrctrl->post(cpu, int_type, 0);
21913531Sjairo.balart@metempsy.com}
22013531Sjairo.balart@metempsy.com
22113531Sjairo.balart@metempsy.comGicv3Redistributor *
22213531Sjairo.balart@metempsy.comGicv3::getRedistributorByAffinity(uint32_t affinity)
22313531Sjairo.balart@metempsy.com{
22413531Sjairo.balart@metempsy.com    for (auto & redistributor : redistributors) {
22513531Sjairo.balart@metempsy.com        if (redistributor->getAffinity() == affinity) {
22613531Sjairo.balart@metempsy.com            return redistributor;
22713531Sjairo.balart@metempsy.com        }
22813531Sjairo.balart@metempsy.com    }
22913531Sjairo.balart@metempsy.com
23013531Sjairo.balart@metempsy.com    return nullptr;
23113531Sjairo.balart@metempsy.com}
23213531Sjairo.balart@metempsy.com
23313531Sjairo.balart@metempsy.comvoid
23413531Sjairo.balart@metempsy.comGicv3::serialize(CheckpointOut & cp) const
23513531Sjairo.balart@metempsy.com{
23613531Sjairo.balart@metempsy.com    distributor->serializeSection(cp, "distributor");
23713531Sjairo.balart@metempsy.com
23813531Sjairo.balart@metempsy.com    for (uint32_t redistributor_id = 0;
23913531Sjairo.balart@metempsy.com         redistributor_id < redistributors.size();
24013531Sjairo.balart@metempsy.com         redistributor_id++)
24113531Sjairo.balart@metempsy.com        redistributors[redistributor_id]->serializeSection(cp,
24213531Sjairo.balart@metempsy.com            csprintf("redistributors.%i", redistributor_id));
24313531Sjairo.balart@metempsy.com
24413531Sjairo.balart@metempsy.com    for (uint32_t cpu_interface_id = 0;
24513531Sjairo.balart@metempsy.com         cpu_interface_id < cpuInterfaces.size();
24613531Sjairo.balart@metempsy.com         cpu_interface_id++)
24713531Sjairo.balart@metempsy.com        cpuInterfaces[cpu_interface_id]->serializeSection(cp,
24813531Sjairo.balart@metempsy.com            csprintf("cpuInterface.%i", cpu_interface_id));
24913531Sjairo.balart@metempsy.com}
25013531Sjairo.balart@metempsy.com
25113531Sjairo.balart@metempsy.comvoid
25213531Sjairo.balart@metempsy.comGicv3::unserialize(CheckpointIn & cp)
25313531Sjairo.balart@metempsy.com{
25413531Sjairo.balart@metempsy.com    getSystem()->setGIC(this);
25513531Sjairo.balart@metempsy.com
25613531Sjairo.balart@metempsy.com    distributor->unserializeSection(cp, "distributor");
25713531Sjairo.balart@metempsy.com
25813531Sjairo.balart@metempsy.com    for (uint32_t redistributor_id = 0;
25913531Sjairo.balart@metempsy.com         redistributor_id < redistributors.size();
26013531Sjairo.balart@metempsy.com         redistributor_id++)
26113531Sjairo.balart@metempsy.com        redistributors[redistributor_id]->unserializeSection(cp,
26213531Sjairo.balart@metempsy.com            csprintf("redistributors.%i", redistributor_id));
26313531Sjairo.balart@metempsy.com
26413531Sjairo.balart@metempsy.com    for (uint32_t cpu_interface_id = 0;
26513531Sjairo.balart@metempsy.com         cpu_interface_id < cpuInterfaces.size();
26613531Sjairo.balart@metempsy.com         cpu_interface_id++)
26713531Sjairo.balart@metempsy.com        cpuInterfaces[cpu_interface_id]->unserializeSection(cp,
26813531Sjairo.balart@metempsy.com            csprintf("cpuInterface.%i", cpu_interface_id));
26913531Sjairo.balart@metempsy.com}
27013531Sjairo.balart@metempsy.com
27113531Sjairo.balart@metempsy.comGicv3 *
27213531Sjairo.balart@metempsy.comGicv3Params::create()
27313531Sjairo.balart@metempsy.com{
27413531Sjairo.balart@metempsy.com    return new Gicv3(this);
27513531Sjairo.balart@metempsy.com}
276