gic_v3_distributor.cc revision 13690
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#include "dev/arm/gic_v3_distributor.hh" 3113531Sjairo.balart@metempsy.com 3213531Sjairo.balart@metempsy.com#include <algorithm> 3313531Sjairo.balart@metempsy.com 3413531Sjairo.balart@metempsy.com#include "debug/GIC.hh" 3513531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3.hh" 3613531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3_cpu_interface.hh" 3713531Sjairo.balart@metempsy.com#include "dev/arm/gic_v3_redistributor.hh" 3813531Sjairo.balart@metempsy.com 3913531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_IGROUPR(0x0080, 0x00ff); 4013531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ISENABLER(0x0100, 0x017f); 4113531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ICENABLER(0x0180, 0x01ff); 4213531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ISPENDR(0x0200, 0x027f); 4313531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ICPENDR(0x0280, 0x02ff); 4413531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ISACTIVER(0x0300, 0x037f); 4513531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ICACTIVER(0x0380, 0x03ff); 4613531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_IPRIORITYR(0x0400, 0x07ff); 4713531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ITARGETSR(0x0800, 0x08ff); 4813531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_ICFGR(0x0c00, 0x0cff); 4913531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_IGRPMODR(0x0d00, 0x0d7f); 5013531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_NSACR(0x0e00, 0x0eff); 5113531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_CPENDSGIR(0x0f10, 0x0f1f); 5213531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_SPENDSGIR(0x0f20, 0x0f2f); 5313531Sjairo.balart@metempsy.comconst AddrRange Gicv3Distributor::GICD_IROUTER(0x6000, 0x7fe0); 5413531Sjairo.balart@metempsy.com 5513531Sjairo.balart@metempsy.comGicv3Distributor::Gicv3Distributor(Gicv3 * gic, uint32_t it_lines) 5613531Sjairo.balart@metempsy.com : gic(gic), 5713531Sjairo.balart@metempsy.com itLines(it_lines), 5813531Sjairo.balart@metempsy.com irqGroup(it_lines), 5913531Sjairo.balart@metempsy.com irqEnabled(it_lines), 6013531Sjairo.balart@metempsy.com irqPending(it_lines), 6113531Sjairo.balart@metempsy.com irqActive(it_lines), 6213531Sjairo.balart@metempsy.com irqPriority(it_lines), 6313531Sjairo.balart@metempsy.com irqConfig(it_lines), 6413531Sjairo.balart@metempsy.com irqGrpmod(it_lines), 6513531Sjairo.balart@metempsy.com irqNsacr(it_lines), 6613531Sjairo.balart@metempsy.com irqAffinityRouting(it_lines) 6713531Sjairo.balart@metempsy.com{ 6813531Sjairo.balart@metempsy.com panic_if(it_lines > Gicv3::INTID_SECURE, "Invalid value for it_lines!"); 6913531Sjairo.balart@metempsy.com} 7013531Sjairo.balart@metempsy.com 7113531Sjairo.balart@metempsy.comGicv3Distributor::~Gicv3Distributor() 7213531Sjairo.balart@metempsy.com{ 7313531Sjairo.balart@metempsy.com} 7413531Sjairo.balart@metempsy.com 7513531Sjairo.balart@metempsy.comvoid 7613531Sjairo.balart@metempsy.comGicv3Distributor::init() 7713531Sjairo.balart@metempsy.com{ 7813531Sjairo.balart@metempsy.com} 7913531Sjairo.balart@metempsy.com 8013531Sjairo.balart@metempsy.comvoid 8113531Sjairo.balart@metempsy.comGicv3Distributor::initState() 8213531Sjairo.balart@metempsy.com{ 8313531Sjairo.balart@metempsy.com reset(); 8413531Sjairo.balart@metempsy.com} 8513531Sjairo.balart@metempsy.com 8613531Sjairo.balart@metempsy.comvoid 8713531Sjairo.balart@metempsy.comGicv3Distributor::reset() 8813531Sjairo.balart@metempsy.com{ 8913531Sjairo.balart@metempsy.com std::fill(irqGroup.begin(), irqGroup.end(), 0); 9013531Sjairo.balart@metempsy.com // Imp. defined reset value 9113531Sjairo.balart@metempsy.com std::fill(irqEnabled.begin(), irqEnabled.end(), false); 9213531Sjairo.balart@metempsy.com std::fill(irqPending.begin(), irqPending.end(), false); 9313531Sjairo.balart@metempsy.com std::fill(irqActive.begin(), irqActive.end(), false); 9413531Sjairo.balart@metempsy.com // Imp. defined reset value 9513531Sjairo.balart@metempsy.com std::fill(irqPriority.begin(), irqPriority.end(), 0xAAAAAAAA); 9613531Sjairo.balart@metempsy.com std::fill(irqConfig.begin(), irqConfig.end(), 9713531Sjairo.balart@metempsy.com Gicv3::INT_LEVEL_SENSITIVE); // Imp. defined reset value 9813531Sjairo.balart@metempsy.com std::fill(irqGrpmod.begin(), irqGrpmod.end(), 0); 9913531Sjairo.balart@metempsy.com std::fill(irqNsacr.begin(), irqNsacr.end(), 0); 10013531Sjairo.balart@metempsy.com /* 10113531Sjairo.balart@metempsy.com * For our implementation affinity routing is always enabled, 10213531Sjairo.balart@metempsy.com * no GICv2 legacy 10313531Sjairo.balart@metempsy.com */ 10413531Sjairo.balart@metempsy.com ARE = true; 10513531Sjairo.balart@metempsy.com 10613531Sjairo.balart@metempsy.com if (gic->getSystem()->haveSecurity()) { 10713531Sjairo.balart@metempsy.com DS = false; 10813531Sjairo.balart@metempsy.com } else { 10913531Sjairo.balart@metempsy.com DS = true; 11013531Sjairo.balart@metempsy.com } 11113531Sjairo.balart@metempsy.com 11213531Sjairo.balart@metempsy.com EnableGrp0 = 0; 11313531Sjairo.balart@metempsy.com EnableGrp1NS = 0; 11413531Sjairo.balart@metempsy.com EnableGrp1S = 0; 11513531Sjairo.balart@metempsy.com} 11613531Sjairo.balart@metempsy.com 11713531Sjairo.balart@metempsy.comuint64_t 11813531Sjairo.balart@metempsy.comGicv3Distributor::read(Addr addr, size_t size, bool is_secure_access) 11913531Sjairo.balart@metempsy.com{ 12013531Sjairo.balart@metempsy.com if (GICD_IGROUPR.contains(addr)) { // Interrupt Group Registers 12113531Sjairo.balart@metempsy.com uint64_t val = 0x0; 12213531Sjairo.balart@metempsy.com 12313531Sjairo.balart@metempsy.com if (!DS && !is_secure_access) { 12413531Sjairo.balart@metempsy.com // RAZ/WI for non-secure accesses 12513531Sjairo.balart@metempsy.com return 0; 12613531Sjairo.balart@metempsy.com } 12713531Sjairo.balart@metempsy.com 12813531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_IGROUPR.start()) * 8; 12913531Sjairo.balart@metempsy.com 13013531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 13113531Sjairo.balart@metempsy.com return 0; 13213531Sjairo.balart@metempsy.com } 13313531Sjairo.balart@metempsy.com 13413531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 13513531Sjairo.balart@metempsy.com i++, int_id++) { 13613531Sjairo.balart@metempsy.com val |= irqGroup[int_id] << i; 13713531Sjairo.balart@metempsy.com } 13813531Sjairo.balart@metempsy.com 13913531Sjairo.balart@metempsy.com return val; 14013531Sjairo.balart@metempsy.com // Interrupt Set-Enable Registers 14113531Sjairo.balart@metempsy.com } else if (GICD_ISENABLER.contains(addr)) { 14213531Sjairo.balart@metempsy.com uint64_t val = 0x0; 14313531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ISENABLER.start()) * 8; 14413531Sjairo.balart@metempsy.com 14513531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 14613531Sjairo.balart@metempsy.com return 0; 14713531Sjairo.balart@metempsy.com } 14813531Sjairo.balart@metempsy.com 14913531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 15013531Sjairo.balart@metempsy.com i++, int_id++) { 15113531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 15213531Sjairo.balart@metempsy.com { 15313531Sjairo.balart@metempsy.com continue; 15413531Sjairo.balart@metempsy.com } 15513531Sjairo.balart@metempsy.com 15613531Sjairo.balart@metempsy.com val |= irqEnabled[int_id] << i; 15713531Sjairo.balart@metempsy.com } 15813531Sjairo.balart@metempsy.com 15913531Sjairo.balart@metempsy.com return val; 16013531Sjairo.balart@metempsy.com } else if (GICD_ICENABLER.contains(addr)) { 16113531Sjairo.balart@metempsy.com // Interrupt Clear-Enable Registers 16213531Sjairo.balart@metempsy.com uint64_t val = 0x0; 16313531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICENABLER.start()) * 8; 16413531Sjairo.balart@metempsy.com 16513531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 16613531Sjairo.balart@metempsy.com return 0; 16713531Sjairo.balart@metempsy.com } 16813531Sjairo.balart@metempsy.com 16913531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 17013531Sjairo.balart@metempsy.com i++, int_id++) { 17113531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 17213531Sjairo.balart@metempsy.com { 17313531Sjairo.balart@metempsy.com continue; 17413531Sjairo.balart@metempsy.com } 17513531Sjairo.balart@metempsy.com 17613531Sjairo.balart@metempsy.com val |= (irqEnabled[int_id] << i); 17713531Sjairo.balart@metempsy.com } 17813531Sjairo.balart@metempsy.com 17913531Sjairo.balart@metempsy.com return val; 18013531Sjairo.balart@metempsy.com } else if (GICD_ISPENDR.contains(addr)) { 18113531Sjairo.balart@metempsy.com uint64_t val = 0x0; 18213531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ISPENDR.start()) * 8; 18313531Sjairo.balart@metempsy.com 18413531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 18513531Sjairo.balart@metempsy.com return 0; 18613531Sjairo.balart@metempsy.com } 18713531Sjairo.balart@metempsy.com 18813531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 18913531Sjairo.balart@metempsy.com i++, int_id++) { 19013531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 19113531Sjairo.balart@metempsy.com { 19213531Sjairo.balart@metempsy.com if (irqNsacr[int_id] == 0) { 19313531Sjairo.balart@metempsy.com // Group 0 or Secure Group 1 interrupts are RAZ/WI 19413531Sjairo.balart@metempsy.com continue; 19513531Sjairo.balart@metempsy.com } 19613531Sjairo.balart@metempsy.com } 19713531Sjairo.balart@metempsy.com 19813531Sjairo.balart@metempsy.com val |= (irqPending[int_id] << i); 19913531Sjairo.balart@metempsy.com } 20013531Sjairo.balart@metempsy.com 20113531Sjairo.balart@metempsy.com return val; 20213531Sjairo.balart@metempsy.com } else if (GICD_ICPENDR.contains(addr)) { 20313531Sjairo.balart@metempsy.com uint64_t val = 0x0; 20413531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICPENDR.start()) * 8; 20513531Sjairo.balart@metempsy.com 20613531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 20713531Sjairo.balart@metempsy.com return 0; 20813531Sjairo.balart@metempsy.com } 20913531Sjairo.balart@metempsy.com 21013531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 21113531Sjairo.balart@metempsy.com i++, int_id++) { 21213531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 21313531Sjairo.balart@metempsy.com { 21413531Sjairo.balart@metempsy.com if (irqNsacr[int_id] < 2) { 21513531Sjairo.balart@metempsy.com // Group 0 or Secure Group 1 interrupts are RAZ/WI 21613531Sjairo.balart@metempsy.com continue; 21713531Sjairo.balart@metempsy.com } 21813531Sjairo.balart@metempsy.com } 21913531Sjairo.balart@metempsy.com 22013531Sjairo.balart@metempsy.com val |= (irqPending[int_id] << i); 22113531Sjairo.balart@metempsy.com } 22213531Sjairo.balart@metempsy.com 22313531Sjairo.balart@metempsy.com return val; 22413531Sjairo.balart@metempsy.com // Interrupt Set-Active Registers 22513531Sjairo.balart@metempsy.com } else if (GICD_ISACTIVER.contains(addr)) { 22613531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ISACTIVER.start()) * 8; 22713531Sjairo.balart@metempsy.com 22813531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 22913531Sjairo.balart@metempsy.com return 0; 23013531Sjairo.balart@metempsy.com } 23113531Sjairo.balart@metempsy.com 23213531Sjairo.balart@metempsy.com uint64_t val = 0x0; 23313531Sjairo.balart@metempsy.com 23413531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 23513531Sjairo.balart@metempsy.com i++, int_id++) { 23613531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 23713531Sjairo.balart@metempsy.com { 23813531Sjairo.balart@metempsy.com // Group 0 or Secure Group 1 interrupts are RAZ/WI 23913531Sjairo.balart@metempsy.com if (irqNsacr[int_id] < 2) { 24013531Sjairo.balart@metempsy.com continue; 24113531Sjairo.balart@metempsy.com } 24213531Sjairo.balart@metempsy.com } 24313531Sjairo.balart@metempsy.com 24413531Sjairo.balart@metempsy.com val |= (irqActive[int_id] << i); 24513531Sjairo.balart@metempsy.com } 24613531Sjairo.balart@metempsy.com 24713531Sjairo.balart@metempsy.com return val; 24813531Sjairo.balart@metempsy.com // Interrupt Clear-Active Registers 24913531Sjairo.balart@metempsy.com } else if (GICD_ICACTIVER.contains(addr)) { 25013531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICACTIVER.start()) * 8; 25113531Sjairo.balart@metempsy.com 25213531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 25313531Sjairo.balart@metempsy.com return 0; 25413531Sjairo.balart@metempsy.com } 25513531Sjairo.balart@metempsy.com 25613531Sjairo.balart@metempsy.com uint64_t val = 0x0; 25713531Sjairo.balart@metempsy.com 25813531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 25913531Sjairo.balart@metempsy.com i++, int_id++) { 26013531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 26113531Sjairo.balart@metempsy.com { 26213531Sjairo.balart@metempsy.com if (irqNsacr[int_id] < 2) { 26313531Sjairo.balart@metempsy.com continue; 26413531Sjairo.balart@metempsy.com } 26513531Sjairo.balart@metempsy.com } 26613531Sjairo.balart@metempsy.com 26713531Sjairo.balart@metempsy.com val |= (irqActive[int_id] << i); 26813531Sjairo.balart@metempsy.com } 26913531Sjairo.balart@metempsy.com 27013531Sjairo.balart@metempsy.com return val; 27113531Sjairo.balart@metempsy.com // Interrupt Priority Registers 27213531Sjairo.balart@metempsy.com } else if (GICD_IPRIORITYR.contains(addr)) { 27313531Sjairo.balart@metempsy.com uint64_t val = 0x0; 27413531Sjairo.balart@metempsy.com int first_intid = addr - GICD_IPRIORITYR.start(); 27513531Sjairo.balart@metempsy.com 27613531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 27713531Sjairo.balart@metempsy.com return 0; 27813531Sjairo.balart@metempsy.com } 27913531Sjairo.balart@metempsy.com 28013531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < size && int_id < itLines; 28113531Sjairo.balart@metempsy.com i++, int_id++) { 28213531Sjairo.balart@metempsy.com uint8_t prio = irqPriority[int_id]; 28313531Sjairo.balart@metempsy.com 28413531Sjairo.balart@metempsy.com if (!DS && !is_secure_access) { 28513531Sjairo.balart@metempsy.com if (getIntGroup(int_id) != Gicv3::G1NS) { 28613531Sjairo.balart@metempsy.com // RAZ/WI for non-secure accesses for secure interrupts 28713531Sjairo.balart@metempsy.com continue; 28813531Sjairo.balart@metempsy.com } else { 28913531Sjairo.balart@metempsy.com // NS view 29013531Sjairo.balart@metempsy.com prio = (prio << 1) & 0xff; 29113531Sjairo.balart@metempsy.com } 29213531Sjairo.balart@metempsy.com } 29313531Sjairo.balart@metempsy.com 29413531Sjairo.balart@metempsy.com val |= prio << (i * 8); 29513531Sjairo.balart@metempsy.com } 29613531Sjairo.balart@metempsy.com 29713531Sjairo.balart@metempsy.com return val; 29813531Sjairo.balart@metempsy.com } else if (GICD_ITARGETSR.contains(addr)) { 29913531Sjairo.balart@metempsy.com // Interrupt Processor Targets Registers 30013531Sjairo.balart@metempsy.com // ARE always on, RAZ/WI 30113531Sjairo.balart@metempsy.com warn("Gicv3Distributor::read(): " 30213531Sjairo.balart@metempsy.com "GICD_ITARGETSR is RAZ/WI, legacy not supported!\n"); 30313531Sjairo.balart@metempsy.com return 0; 30413531Sjairo.balart@metempsy.com // Interrupt Configuration Registers 30513531Sjairo.balart@metempsy.com } else if (GICD_ICFGR.contains(addr)) { 30613531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICFGR.start()) * 4; 30713531Sjairo.balart@metempsy.com 30813531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 30913531Sjairo.balart@metempsy.com return 0; 31013531Sjairo.balart@metempsy.com } 31113531Sjairo.balart@metempsy.com 31213531Sjairo.balart@metempsy.com uint64_t val = 0x0; 31313531Sjairo.balart@metempsy.com 31413531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 31513531Sjairo.balart@metempsy.com i = i + 2, int_id++) { 31613531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 31713531Sjairo.balart@metempsy.com { 31813531Sjairo.balart@metempsy.com continue; 31913531Sjairo.balart@metempsy.com } 32013531Sjairo.balart@metempsy.com 32113531Sjairo.balart@metempsy.com if (irqConfig[int_id] == Gicv3::INT_EDGE_TRIGGERED) { 32213531Sjairo.balart@metempsy.com val |= (0x2 << i); 32313531Sjairo.balart@metempsy.com } 32413531Sjairo.balart@metempsy.com } 32513531Sjairo.balart@metempsy.com 32613531Sjairo.balart@metempsy.com return val; 32713531Sjairo.balart@metempsy.com } else if (GICD_IGRPMODR.contains(addr)) { 32813531Sjairo.balart@metempsy.com // Interrupt Group Modifier Registers 32913531Sjairo.balart@metempsy.com if (DS) { 33013531Sjairo.balart@metempsy.com // RAZ/WI if security disabled 33113531Sjairo.balart@metempsy.com return 0; 33213531Sjairo.balart@metempsy.com } else { 33313531Sjairo.balart@metempsy.com if (!is_secure_access) { 33413531Sjairo.balart@metempsy.com // RAZ/WI for non-secure accesses 33513531Sjairo.balart@metempsy.com return 0; 33613531Sjairo.balart@metempsy.com } else { 33713531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_IGRPMODR.start()) * 8; 33813531Sjairo.balart@metempsy.com 33913531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 34013531Sjairo.balart@metempsy.com return 0; 34113531Sjairo.balart@metempsy.com } 34213531Sjairo.balart@metempsy.com 34313531Sjairo.balart@metempsy.com uint64_t val = 0x0; 34413531Sjairo.balart@metempsy.com 34513531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; 34613531Sjairo.balart@metempsy.com i < 8 * size && int_id < itLines; i++, int_id++) { 34713531Sjairo.balart@metempsy.com val |= irqGrpmod[int_id] << i; 34813531Sjairo.balart@metempsy.com } 34913531Sjairo.balart@metempsy.com 35013531Sjairo.balart@metempsy.com return val; 35113531Sjairo.balart@metempsy.com } 35213531Sjairo.balart@metempsy.com } 35313531Sjairo.balart@metempsy.com 35413531Sjairo.balart@metempsy.com // Non-secure Access Control Registers 35513531Sjairo.balart@metempsy.com } else if (GICD_NSACR.contains(addr)) { 35613531Sjairo.balart@metempsy.com // 2 bits per interrupt 35713531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_NSACR.start()) * 4; 35813531Sjairo.balart@metempsy.com 35913531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 36013531Sjairo.balart@metempsy.com return 0; 36113531Sjairo.balart@metempsy.com } 36213531Sjairo.balart@metempsy.com 36313531Sjairo.balart@metempsy.com if (DS || (!DS && !is_secure_access)) { 36413531Sjairo.balart@metempsy.com return 0; 36513531Sjairo.balart@metempsy.com } 36613531Sjairo.balart@metempsy.com 36713531Sjairo.balart@metempsy.com uint64_t val = 0x0; 36813531Sjairo.balart@metempsy.com 36913531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; 37013531Sjairo.balart@metempsy.com i < 8 * size && int_id < itLines; i = i + 2, int_id++) { 37113531Sjairo.balart@metempsy.com val |= irqNsacr[int_id] << i; 37213531Sjairo.balart@metempsy.com } 37313531Sjairo.balart@metempsy.com 37413531Sjairo.balart@metempsy.com return val; 37513531Sjairo.balart@metempsy.com } else if (GICD_CPENDSGIR.contains(addr)) { // SGI Clear-Pending Registers 37613531Sjairo.balart@metempsy.com // ARE always on, RAZ/WI 37713531Sjairo.balart@metempsy.com warn("Gicv3Distributor::read(): " 37813531Sjairo.balart@metempsy.com "GICD_CPENDSGIR is RAZ/WI, legacy not supported!\n"); 37913531Sjairo.balart@metempsy.com return 0x0; 38013531Sjairo.balart@metempsy.com } else if (GICD_SPENDSGIR.contains(addr)) { // SGI Set-Pending Registers 38113531Sjairo.balart@metempsy.com // ARE always on, RAZ/WI 38213531Sjairo.balart@metempsy.com warn("Gicv3Distributor::read(): " 38313531Sjairo.balart@metempsy.com "GICD_SPENDSGIR is RAZ/WI, legacy not supported!\n"); 38413531Sjairo.balart@metempsy.com return 0x0; 38513531Sjairo.balart@metempsy.com } else if (GICD_IROUTER.contains(addr)) { // Interrupt Routing Registers 38613531Sjairo.balart@metempsy.com // 64 bit registers. 2 or 1 access. 38713531Sjairo.balart@metempsy.com int int_id = (addr - GICD_IROUTER.start()) / 8; 38813531Sjairo.balart@metempsy.com 38913531Sjairo.balart@metempsy.com if (isNotSPI(int_id)) { 39013531Sjairo.balart@metempsy.com return 0; 39113531Sjairo.balart@metempsy.com } 39213531Sjairo.balart@metempsy.com 39313531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 39413531Sjairo.balart@metempsy.com { 39513531Sjairo.balart@metempsy.com if (irqNsacr[int_id] < 3) { 39613531Sjairo.balart@metempsy.com return 0; 39713531Sjairo.balart@metempsy.com } 39813531Sjairo.balart@metempsy.com } 39913531Sjairo.balart@metempsy.com 40013531Sjairo.balart@metempsy.com if (size == 4) { 40113531Sjairo.balart@metempsy.com if (addr & 7) { // high half of 64 bit register 40213531Sjairo.balart@metempsy.com return irqAffinityRouting[int_id] >> 32; 40313531Sjairo.balart@metempsy.com } else { // high low of 64 bit register 40413531Sjairo.balart@metempsy.com return irqAffinityRouting[int_id] & 0xFFFFFFFF; 40513531Sjairo.balart@metempsy.com } 40613531Sjairo.balart@metempsy.com } else { 40713531Sjairo.balart@metempsy.com return irqAffinityRouting[int_id]; 40813531Sjairo.balart@metempsy.com } 40913531Sjairo.balart@metempsy.com } 41013531Sjairo.balart@metempsy.com 41113531Sjairo.balart@metempsy.com switch (addr) { 41213531Sjairo.balart@metempsy.com case GICD_CTLR: // Control Register 41313531Sjairo.balart@metempsy.com if (!DS) { 41413531Sjairo.balart@metempsy.com if (is_secure_access) { 41513531Sjairo.balart@metempsy.com // E1NWF [7] RAZ/WI 41613531Sjairo.balart@metempsy.com // DS [6] - Disable Security 41713531Sjairo.balart@metempsy.com // ARE_NS [5] RAO/WI 41813531Sjairo.balart@metempsy.com // ARE_S [4] RAO/WI 41913531Sjairo.balart@metempsy.com // EnableGrp1S [2] 42013531Sjairo.balart@metempsy.com // EnableGrp1NS [1] 42113531Sjairo.balart@metempsy.com // EnableGrp0 [0] 42213531Sjairo.balart@metempsy.com return (EnableGrp0 << 0) | 42313531Sjairo.balart@metempsy.com (EnableGrp1NS << 1) | 42413531Sjairo.balart@metempsy.com (EnableGrp1S << 2) | 42513531Sjairo.balart@metempsy.com (1 << 4) | 42613531Sjairo.balart@metempsy.com (1 << 5) | 42713531Sjairo.balart@metempsy.com (DS << 6); 42813531Sjairo.balart@metempsy.com } else { 42913531Sjairo.balart@metempsy.com // ARE_NS [4] RAO/WI; 43013531Sjairo.balart@metempsy.com // EnableGrp1A [1] is a read-write alias of the Secure 43113531Sjairo.balart@metempsy.com // GICD_CTLR.EnableGrp1NS 43213531Sjairo.balart@metempsy.com // EnableGrp1 [0] RES0 43313531Sjairo.balart@metempsy.com return (1 << 4) | (EnableGrp1NS << 1); 43413531Sjairo.balart@metempsy.com } 43513531Sjairo.balart@metempsy.com } else { 43613531Sjairo.balart@metempsy.com return (DS << 6) | (ARE << 4) | 43713531Sjairo.balart@metempsy.com (EnableGrp1NS << 1) | (EnableGrp0 << 0); 43813531Sjairo.balart@metempsy.com } 43913531Sjairo.balart@metempsy.com 44013531Sjairo.balart@metempsy.com case GICD_TYPER: // Interrupt Controller Type Register 44113531Sjairo.balart@metempsy.com /* 44213531Sjairo.balart@metempsy.com * RSS [26] == 1 44313531Sjairo.balart@metempsy.com * (The implementation does supports targeted SGIs with affinity 44413531Sjairo.balart@metempsy.com * level 0 values of 0 - 255) 44513531Sjairo.balart@metempsy.com * No1N [25] == 1 44613531Sjairo.balart@metempsy.com * (1 of N SPI interrupts are not supported) 44713531Sjairo.balart@metempsy.com * A3V [24] == 1 44813531Sjairo.balart@metempsy.com * (Supports nonzero values of Affinity level 3) 44913531Sjairo.balart@metempsy.com * IDbits [23:19] == 0xf 45013531Sjairo.balart@metempsy.com * (The number of interrupt identifier bits supported, minus one) 45113531Sjairo.balart@metempsy.com * DVIS [18] == 0 45213531Sjairo.balart@metempsy.com * (The implementation does not support Direct Virtual LPI 45313531Sjairo.balart@metempsy.com * injection) 45413690Sjairo.balart@metempsy.com * LPIS [17] == 1 45513531Sjairo.balart@metempsy.com * (The implementation does not support LPIs) 45613531Sjairo.balart@metempsy.com * MBIS [16] == 0 45713531Sjairo.balart@metempsy.com * (The implementation does not support message-based interrupts 45813531Sjairo.balart@metempsy.com * by writing to Distributor registers) 45913531Sjairo.balart@metempsy.com * SecurityExtn [10] == X 46013531Sjairo.balart@metempsy.com * (The GIC implementation supports two Security states) 46113531Sjairo.balart@metempsy.com * CPUNumber [7:5] == 0 46213531Sjairo.balart@metempsy.com * (since for us ARE is always 1 [(ARE = 0) == Gicv2 legacy]) 46313531Sjairo.balart@metempsy.com * ITLinesNumber [4:0] == N 46413531Sjairo.balart@metempsy.com * (MaxSPIIntId = 32 (N + 1) - 1) 46513531Sjairo.balart@metempsy.com */ 46613531Sjairo.balart@metempsy.com { 46713531Sjairo.balart@metempsy.com int max_spi_int_id = itLines - 1; 46813531Sjairo.balart@metempsy.com int it_lines_number = ceil((max_spi_int_id + 1) / 32.0) - 1; 46913531Sjairo.balart@metempsy.com return (1 << 26) | (1 << 25) | (1 << 24) | (0xf << 19) | 47013690Sjairo.balart@metempsy.com (1 << 17) | (gic->getSystem()->haveSecurity() << 10) | 47113531Sjairo.balart@metempsy.com (it_lines_number << 0); 47213531Sjairo.balart@metempsy.com } 47313531Sjairo.balart@metempsy.com 47413531Sjairo.balart@metempsy.com case GICD_IIDR: // Implementer Identification Register 47513531Sjairo.balart@metempsy.com //return 0x43b; // ARM JEP106 code (r0p0 GIC-500) 47613531Sjairo.balart@metempsy.com return 0; 47713531Sjairo.balart@metempsy.com 47813531Sjairo.balart@metempsy.com case GICD_STATUSR: // Error Reporting Status Register 47913531Sjairo.balart@metempsy.com // Optional register, RAZ/WI 48013531Sjairo.balart@metempsy.com return 0x0; 48113531Sjairo.balart@metempsy.com 48213531Sjairo.balart@metempsy.com case GICD_PIDR0: { // Peripheral ID0 Register 48313531Sjairo.balart@metempsy.com uint8_t part_0 = 0x92; // Part number, bits[7:0] 48413531Sjairo.balart@metempsy.com return part_0; 48513531Sjairo.balart@metempsy.com } 48613531Sjairo.balart@metempsy.com 48713531Sjairo.balart@metempsy.com case GICD_PIDR1: { // Peripheral ID1 Register 48813531Sjairo.balart@metempsy.com uint8_t des_0 = 0xB; // JEP106 identification code, bits[3:0] 48913531Sjairo.balart@metempsy.com uint8_t part_1 = 0x4; // Part number, bits[11:8] 49013531Sjairo.balart@metempsy.com return (des_0 << 4) | (part_1 << 0); 49113531Sjairo.balart@metempsy.com } 49213531Sjairo.balart@metempsy.com 49313531Sjairo.balart@metempsy.com case GICD_PIDR2: { // Peripheral ID2 Register 49413531Sjairo.balart@metempsy.com uint8_t arch_rev = 0x3; // 0x3 GICv3 49513531Sjairo.balart@metempsy.com uint8_t jdec = 0x1; // JEP code 49613531Sjairo.balart@metempsy.com uint8_t des_1 = 0x3; // JEP106 identification code, bits[6:4] 49713531Sjairo.balart@metempsy.com return (arch_rev << 4) | (jdec << 3) | (des_1 << 0); 49813531Sjairo.balart@metempsy.com } 49913531Sjairo.balart@metempsy.com 50013531Sjairo.balart@metempsy.com case GICD_PIDR3: // Peripheral ID3 Register 50113531Sjairo.balart@metempsy.com return 0x0; // Implementation defined 50213531Sjairo.balart@metempsy.com 50313531Sjairo.balart@metempsy.com case GICD_PIDR4: { // Peripheral ID4 Register 50413531Sjairo.balart@metempsy.com uint8_t size = 0x4; // 64 KB software visible page 50513531Sjairo.balart@metempsy.com uint8_t des_2 = 0x4; // ARM implementation 50613531Sjairo.balart@metempsy.com return (size << 4) | (des_2 << 0); 50713531Sjairo.balart@metempsy.com } 50813531Sjairo.balart@metempsy.com 50913531Sjairo.balart@metempsy.com case GICD_PIDR5: // Peripheral ID5 Register 51013531Sjairo.balart@metempsy.com case GICD_PIDR6: // Peripheral ID6 Register 51113531Sjairo.balart@metempsy.com case GICD_PIDR7: // Peripheral ID7 Register 51213531Sjairo.balart@metempsy.com return 0; // RES0 51313531Sjairo.balart@metempsy.com 51413531Sjairo.balart@metempsy.com default: 51513531Sjairo.balart@metempsy.com panic("Gicv3Distributor::read(): invalid offset %#x\n", addr); 51613531Sjairo.balart@metempsy.com break; 51713531Sjairo.balart@metempsy.com } 51813531Sjairo.balart@metempsy.com} 51913531Sjairo.balart@metempsy.com 52013531Sjairo.balart@metempsy.comvoid 52113531Sjairo.balart@metempsy.comGicv3Distributor::write(Addr addr, uint64_t data, size_t size, 52213531Sjairo.balart@metempsy.com bool is_secure_access) 52313531Sjairo.balart@metempsy.com{ 52413531Sjairo.balart@metempsy.com if (GICD_IGROUPR.contains(addr)) { // Interrupt Group Registers 52513531Sjairo.balart@metempsy.com if (!DS && !is_secure_access) { 52613531Sjairo.balart@metempsy.com // RAZ/WI for non-secure accesses 52713531Sjairo.balart@metempsy.com return; 52813531Sjairo.balart@metempsy.com } 52913531Sjairo.balart@metempsy.com 53013531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_IGROUPR.start()) * 8; 53113531Sjairo.balart@metempsy.com 53213531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 53313531Sjairo.balart@metempsy.com return; 53413531Sjairo.balart@metempsy.com } 53513531Sjairo.balart@metempsy.com 53613531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 53713531Sjairo.balart@metempsy.com i++, int_id++) { 53813531Sjairo.balart@metempsy.com irqGroup[int_id] = data & (1 << i) ? 1 : 0; 53913531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): int_id %d group %d\n", 54013531Sjairo.balart@metempsy.com int_id, irqGroup[int_id]); 54113531Sjairo.balart@metempsy.com } 54213531Sjairo.balart@metempsy.com 54313531Sjairo.balart@metempsy.com return; 54413531Sjairo.balart@metempsy.com // Interrupt Set-Enable Registers 54513531Sjairo.balart@metempsy.com } else if (GICD_ISENABLER.contains(addr)) { 54613531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ISENABLER.start()) * 8; 54713531Sjairo.balart@metempsy.com 54813531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 54913531Sjairo.balart@metempsy.com return; 55013531Sjairo.balart@metempsy.com } 55113531Sjairo.balart@metempsy.com 55213531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 55313531Sjairo.balart@metempsy.com i++, int_id++) { 55413531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 55513531Sjairo.balart@metempsy.com { 55613531Sjairo.balart@metempsy.com continue; 55713531Sjairo.balart@metempsy.com } 55813531Sjairo.balart@metempsy.com 55913531Sjairo.balart@metempsy.com bool enable = data & (1 << i) ? 1 : 0; 56013531Sjairo.balart@metempsy.com 56113531Sjairo.balart@metempsy.com if (enable) { 56213531Sjairo.balart@metempsy.com if (!irqEnabled[int_id]) { 56313531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): " 56413531Sjairo.balart@metempsy.com "int_id %d enabled\n", int_id); 56513531Sjairo.balart@metempsy.com } 56613531Sjairo.balart@metempsy.com 56713531Sjairo.balart@metempsy.com irqEnabled[int_id] = true; 56813531Sjairo.balart@metempsy.com } 56913531Sjairo.balart@metempsy.com } 57013531Sjairo.balart@metempsy.com 57113531Sjairo.balart@metempsy.com return; 57213531Sjairo.balart@metempsy.com } else if (GICD_ICENABLER.contains(addr)) { 57313531Sjairo.balart@metempsy.com // Interrupt Clear-Enable Registers 57413531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICENABLER.start()) * 8; 57513531Sjairo.balart@metempsy.com 57613531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 57713531Sjairo.balart@metempsy.com i++, int_id++) { 57813531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 57913531Sjairo.balart@metempsy.com { 58013531Sjairo.balart@metempsy.com continue; 58113531Sjairo.balart@metempsy.com } 58213531Sjairo.balart@metempsy.com 58313531Sjairo.balart@metempsy.com bool disable = data & (1 << i) ? 1 : 0; 58413531Sjairo.balart@metempsy.com 58513531Sjairo.balart@metempsy.com if (disable) { 58613531Sjairo.balart@metempsy.com if (irqEnabled[int_id]) { 58713531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): " 58813531Sjairo.balart@metempsy.com "int_id %d disabled\n", int_id); 58913531Sjairo.balart@metempsy.com } 59013531Sjairo.balart@metempsy.com 59113531Sjairo.balart@metempsy.com irqEnabled[int_id] = false; 59213531Sjairo.balart@metempsy.com } 59313531Sjairo.balart@metempsy.com } 59413531Sjairo.balart@metempsy.com 59513531Sjairo.balart@metempsy.com return; 59613531Sjairo.balart@metempsy.com } else if (GICD_ISPENDR.contains(addr)) { 59713531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ISPENDR.start()) * 8; 59813531Sjairo.balart@metempsy.com 59913531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 60013531Sjairo.balart@metempsy.com return; 60113531Sjairo.balart@metempsy.com } 60213531Sjairo.balart@metempsy.com 60313531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 60413531Sjairo.balart@metempsy.com i++, int_id++) { 60513531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 60613531Sjairo.balart@metempsy.com { 60713531Sjairo.balart@metempsy.com if (irqNsacr[int_id] == 0) { 60813531Sjairo.balart@metempsy.com // Group 0 or Secure Group 1 interrupts are RAZ/WI 60913531Sjairo.balart@metempsy.com continue; 61013531Sjairo.balart@metempsy.com } 61113531Sjairo.balart@metempsy.com } 61213531Sjairo.balart@metempsy.com 61313531Sjairo.balart@metempsy.com bool pending = data & (1 << i) ? 1 : 0; 61413531Sjairo.balart@metempsy.com 61513531Sjairo.balart@metempsy.com if (pending) { 61613531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write() (GICD_ISPENDR): " 61713531Sjairo.balart@metempsy.com "int_id %d (SPI) pending bit set\n", int_id); 61813531Sjairo.balart@metempsy.com irqPending[int_id] = true; 61913531Sjairo.balart@metempsy.com } 62013531Sjairo.balart@metempsy.com } 62113531Sjairo.balart@metempsy.com 62213531Sjairo.balart@metempsy.com updateAndInformCPUInterfaces(); 62313531Sjairo.balart@metempsy.com return; 62413531Sjairo.balart@metempsy.com } else if (GICD_ICPENDR.contains(addr)) { 62513531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICPENDR.start()) * 8; 62613531Sjairo.balart@metempsy.com 62713531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 62813531Sjairo.balart@metempsy.com return; 62913531Sjairo.balart@metempsy.com } 63013531Sjairo.balart@metempsy.com 63113531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 63213531Sjairo.balart@metempsy.com i++, int_id++) { 63313531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 63413531Sjairo.balart@metempsy.com { 63513531Sjairo.balart@metempsy.com if (irqNsacr[int_id] < 2) { 63613531Sjairo.balart@metempsy.com // Group 0 or Secure Group 1 interrupts are RAZ/WI 63713531Sjairo.balart@metempsy.com continue; 63813531Sjairo.balart@metempsy.com } 63913531Sjairo.balart@metempsy.com } 64013531Sjairo.balart@metempsy.com 64113531Sjairo.balart@metempsy.com bool clear = data & (1 << i) ? 1 : 0; 64213531Sjairo.balart@metempsy.com 64313531Sjairo.balart@metempsy.com if (clear) { 64413531Sjairo.balart@metempsy.com irqPending[int_id] = false; 64513531Sjairo.balart@metempsy.com } 64613531Sjairo.balart@metempsy.com } 64713531Sjairo.balart@metempsy.com 64813531Sjairo.balart@metempsy.com updateAndInformCPUInterfaces(); 64913531Sjairo.balart@metempsy.com return; 65013531Sjairo.balart@metempsy.com // Interrupt Set-Active Registers 65113531Sjairo.balart@metempsy.com } else if (GICD_ISACTIVER.contains(addr)) { 65213531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ISACTIVER.start()) * 8; 65313531Sjairo.balart@metempsy.com 65413531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 65513531Sjairo.balart@metempsy.com return; 65613531Sjairo.balart@metempsy.com } 65713531Sjairo.balart@metempsy.com 65813531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 65913531Sjairo.balart@metempsy.com i++, int_id++) { 66013531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 66113531Sjairo.balart@metempsy.com { 66213531Sjairo.balart@metempsy.com continue; 66313531Sjairo.balart@metempsy.com } 66413531Sjairo.balart@metempsy.com 66513531Sjairo.balart@metempsy.com bool active = data & (1 << i) ? 1 : 0; 66613531Sjairo.balart@metempsy.com 66713531Sjairo.balart@metempsy.com if (active) { 66813531Sjairo.balart@metempsy.com irqActive[int_id] = 1; 66913531Sjairo.balart@metempsy.com } 67013531Sjairo.balart@metempsy.com } 67113531Sjairo.balart@metempsy.com 67213531Sjairo.balart@metempsy.com return; 67313531Sjairo.balart@metempsy.com } else if (GICD_ICACTIVER.contains(addr)) { 67413531Sjairo.balart@metempsy.com // Interrupt Clear-Active Registers 67513531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICACTIVER.start()) * 8; 67613531Sjairo.balart@metempsy.com 67713531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 67813531Sjairo.balart@metempsy.com return; 67913531Sjairo.balart@metempsy.com } 68013531Sjairo.balart@metempsy.com 68113531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 68213531Sjairo.balart@metempsy.com i++, int_id++) { 68313531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 68413531Sjairo.balart@metempsy.com { 68513531Sjairo.balart@metempsy.com continue; 68613531Sjairo.balart@metempsy.com } 68713531Sjairo.balart@metempsy.com 68813531Sjairo.balart@metempsy.com bool clear = data & (1 << i) ? 1 : 0; 68913531Sjairo.balart@metempsy.com 69013531Sjairo.balart@metempsy.com if (clear) { 69113531Sjairo.balart@metempsy.com if (irqActive[int_id]) { 69213531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): " 69313531Sjairo.balart@metempsy.com "int_id %d active cleared\n", int_id); 69413531Sjairo.balart@metempsy.com } 69513531Sjairo.balart@metempsy.com 69613531Sjairo.balart@metempsy.com irqActive[int_id] = false; 69713531Sjairo.balart@metempsy.com } 69813531Sjairo.balart@metempsy.com } 69913531Sjairo.balart@metempsy.com 70013531Sjairo.balart@metempsy.com return; 70113531Sjairo.balart@metempsy.com // Interrupt Priority Registers 70213531Sjairo.balart@metempsy.com } else if (GICD_IPRIORITYR.contains(addr)) { 70313531Sjairo.balart@metempsy.com int first_intid = addr - GICD_IPRIORITYR.start(); 70413531Sjairo.balart@metempsy.com 70513531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 70613531Sjairo.balart@metempsy.com return; 70713531Sjairo.balart@metempsy.com } 70813531Sjairo.balart@metempsy.com 70913531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < size && int_id < itLines; 71013531Sjairo.balart@metempsy.com i++, int_id++) { 71113531Sjairo.balart@metempsy.com uint8_t prio = bits(data, (i + 1) * 8 - 1, (i * 8)); 71213531Sjairo.balart@metempsy.com 71313531Sjairo.balart@metempsy.com if (!DS && !is_secure_access) { 71413531Sjairo.balart@metempsy.com if (getIntGroup(int_id) != Gicv3::G1NS) { 71513531Sjairo.balart@metempsy.com // RAZ/WI for non-secure accesses to secure interrupts 71613531Sjairo.balart@metempsy.com continue; 71713531Sjairo.balart@metempsy.com } else { 71813531Sjairo.balart@metempsy.com prio = 0x80 | (prio >> 1); 71913531Sjairo.balart@metempsy.com } 72013531Sjairo.balart@metempsy.com } 72113531Sjairo.balart@metempsy.com 72213531Sjairo.balart@metempsy.com irqPriority[int_id] = prio; 72313531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): int_id %d priority %d\n", 72413531Sjairo.balart@metempsy.com int_id, irqPriority[int_id]); 72513531Sjairo.balart@metempsy.com } 72613531Sjairo.balart@metempsy.com 72713531Sjairo.balart@metempsy.com return; 72813531Sjairo.balart@metempsy.com } else if (GICD_ITARGETSR.contains(addr)) { 72913531Sjairo.balart@metempsy.com // Interrupt Processor Targets Registers 73013531Sjairo.balart@metempsy.com // ARE always on, RAZ/WI 73113531Sjairo.balart@metempsy.com warn("Gicv3Distributor::write(): " 73213531Sjairo.balart@metempsy.com "GICD_ITARGETSR is RAZ/WI, legacy not supported!\n"); 73313531Sjairo.balart@metempsy.com return; 73413531Sjairo.balart@metempsy.com // Interrupt Configuration Registers 73513531Sjairo.balart@metempsy.com } else if (GICD_ICFGR.contains(addr)) { 73613531Sjairo.balart@metempsy.com /* Here only the odd bits are used; even bits are RES0 */ 73713531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_ICFGR.start()) * 4; 73813531Sjairo.balart@metempsy.com 73913531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 74013531Sjairo.balart@metempsy.com return; 74113531Sjairo.balart@metempsy.com } 74213531Sjairo.balart@metempsy.com 74313531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; i < 8 * size && int_id < itLines; 74413531Sjairo.balart@metempsy.com i = i + 2, int_id++) { 74513531Sjairo.balart@metempsy.com irqConfig[int_id] = data & (0x2 << i) ? 74613531Sjairo.balart@metempsy.com Gicv3::INT_EDGE_TRIGGERED : 74713531Sjairo.balart@metempsy.com Gicv3::INT_LEVEL_SENSITIVE; 74813531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): int_id %d config %d\n", 74913531Sjairo.balart@metempsy.com int_id, irqConfig[int_id]); 75013531Sjairo.balart@metempsy.com } 75113531Sjairo.balart@metempsy.com 75213531Sjairo.balart@metempsy.com return; 75313531Sjairo.balart@metempsy.com } else if (GICD_IGRPMODR.contains(addr)) { 75413531Sjairo.balart@metempsy.com // Interrupt Group Modifier Registers 75513531Sjairo.balart@metempsy.com if (DS) { 75613531Sjairo.balart@metempsy.com return; 75713531Sjairo.balart@metempsy.com } else { 75813531Sjairo.balart@metempsy.com if (!is_secure_access) { 75913531Sjairo.balart@metempsy.com // RAZ/WI for non-secure accesses 76013531Sjairo.balart@metempsy.com return; 76113531Sjairo.balart@metempsy.com } else { 76213531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_IGRPMODR.start()) * 8; 76313531Sjairo.balart@metempsy.com 76413531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 76513531Sjairo.balart@metempsy.com return; 76613531Sjairo.balart@metempsy.com } 76713531Sjairo.balart@metempsy.com 76813531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; 76913531Sjairo.balart@metempsy.com i < 8 * size && int_id < itLines; i++, int_id++) { 77013531Sjairo.balart@metempsy.com irqGrpmod[int_id] = data & (0x1 << i); 77113531Sjairo.balart@metempsy.com } 77213531Sjairo.balart@metempsy.com 77313531Sjairo.balart@metempsy.com return ; 77413531Sjairo.balart@metempsy.com } 77513531Sjairo.balart@metempsy.com } 77613531Sjairo.balart@metempsy.com 77713531Sjairo.balart@metempsy.com // Non-secure Access Control Registers 77813531Sjairo.balart@metempsy.com } else if (GICD_NSACR.contains(addr)) { 77913531Sjairo.balart@metempsy.com // 2 bits per interrupt 78013531Sjairo.balart@metempsy.com int first_intid = (addr - GICD_NSACR.start()) * 4; 78113531Sjairo.balart@metempsy.com 78213531Sjairo.balart@metempsy.com if (isNotSPI(first_intid)) { 78313531Sjairo.balart@metempsy.com return; 78413531Sjairo.balart@metempsy.com } 78513531Sjairo.balart@metempsy.com 78613531Sjairo.balart@metempsy.com if (DS || (!DS && !is_secure_access)) { 78713531Sjairo.balart@metempsy.com return; 78813531Sjairo.balart@metempsy.com } 78913531Sjairo.balart@metempsy.com 79013531Sjairo.balart@metempsy.com for (int i = 0, int_id = first_intid; 79113531Sjairo.balart@metempsy.com i < 8 * size && int_id < itLines; i = i + 2, int_id++) { 79213531Sjairo.balart@metempsy.com irqNsacr[int_id] = (data >> (2 * int_id)) & 0x3; 79313531Sjairo.balart@metempsy.com } 79413531Sjairo.balart@metempsy.com 79513531Sjairo.balart@metempsy.com return; 79613531Sjairo.balart@metempsy.com } else if (GICD_IROUTER.contains(addr)) { // Interrupt Routing Registers 79713531Sjairo.balart@metempsy.com // 64 bit registers. 2 accesses. 79813531Sjairo.balart@metempsy.com int int_id = (addr - GICD_IROUTER.start()) / 8; 79913531Sjairo.balart@metempsy.com 80013531Sjairo.balart@metempsy.com if (isNotSPI(int_id)) { 80113531Sjairo.balart@metempsy.com return; 80213531Sjairo.balart@metempsy.com } 80313531Sjairo.balart@metempsy.com 80413531Sjairo.balart@metempsy.com if (nsAccessToSecInt(int_id, is_secure_access)) 80513531Sjairo.balart@metempsy.com { 80613531Sjairo.balart@metempsy.com if (irqNsacr[int_id] < 3) { 80713531Sjairo.balart@metempsy.com // Group 0 or Secure Group 1 interrupts are RAZ/WI 80813531Sjairo.balart@metempsy.com return; 80913531Sjairo.balart@metempsy.com } 81013531Sjairo.balart@metempsy.com } 81113531Sjairo.balart@metempsy.com 81213531Sjairo.balart@metempsy.com if (size == 4) { 81313531Sjairo.balart@metempsy.com if (addr & 7) { // high half of 64 bit register 81413531Sjairo.balart@metempsy.com irqAffinityRouting[int_id] = 81513531Sjairo.balart@metempsy.com (irqAffinityRouting[int_id] & 0xffffffff) | (data << 32); 81613531Sjairo.balart@metempsy.com } else { // low half of 64 bit register 81713531Sjairo.balart@metempsy.com irqAffinityRouting[int_id] = 81813531Sjairo.balart@metempsy.com (irqAffinityRouting[int_id] & 0xffffffff00000000) | 81913531Sjairo.balart@metempsy.com (data & 0xffffffff); 82013531Sjairo.balart@metempsy.com } 82113531Sjairo.balart@metempsy.com } else { 82213531Sjairo.balart@metempsy.com irqAffinityRouting[int_id] = data; 82313531Sjairo.balart@metempsy.com } 82413531Sjairo.balart@metempsy.com 82513531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): " 82613531Sjairo.balart@metempsy.com "int_id %d GICD_IROUTER %#llx\n", 82713531Sjairo.balart@metempsy.com int_id, irqAffinityRouting[int_id]); 82813531Sjairo.balart@metempsy.com return; 82913531Sjairo.balart@metempsy.com } 83013531Sjairo.balart@metempsy.com 83113531Sjairo.balart@metempsy.com switch (addr) { 83213531Sjairo.balart@metempsy.com case GICD_CTLR: // Control Register 83313531Sjairo.balart@metempsy.com if (DS) { 83413531Sjairo.balart@metempsy.com /* 83513531Sjairo.balart@metempsy.com * E1NWF [7] 83613531Sjairo.balart@metempsy.com * 1 of N wakeup functionality not supported, RAZ/WI 83713531Sjairo.balart@metempsy.com * DS [6] - RAO/WI 83813531Sjairo.balart@metempsy.com * ARE [4] 83913531Sjairo.balart@metempsy.com * affinity routing always on, no GICv2 legacy, RAO/WI 84013531Sjairo.balart@metempsy.com * EnableGrp1 [1] 84113531Sjairo.balart@metempsy.com * EnableGrp0 [0] 84213531Sjairo.balart@metempsy.com */ 84313531Sjairo.balart@metempsy.com if ((data & (1 << 4)) == 0) { 84413531Sjairo.balart@metempsy.com warn("Gicv3Distributor::write(): " 84513531Sjairo.balart@metempsy.com "setting ARE to 0 is not supported!\n"); 84613531Sjairo.balart@metempsy.com } 84713531Sjairo.balart@metempsy.com 84813531Sjairo.balart@metempsy.com EnableGrp1NS = data & GICD_CTLR_ENABLEGRP1NS; 84913531Sjairo.balart@metempsy.com EnableGrp0 = data & GICD_CTLR_ENABLEGRP0; 85013531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): (DS 1)" 85113531Sjairo.balart@metempsy.com "EnableGrp1NS %d EnableGrp0 %d\n", 85213531Sjairo.balart@metempsy.com EnableGrp1NS, EnableGrp0); 85313531Sjairo.balart@metempsy.com } else { 85413531Sjairo.balart@metempsy.com if (is_secure_access) { 85513531Sjairo.balart@metempsy.com /* 85613531Sjairo.balart@metempsy.com * E1NWF [7] 85713531Sjairo.balart@metempsy.com * 1 of N wakeup functionality not supported, RAZ/WI 85813531Sjairo.balart@metempsy.com * DS [6] 85913531Sjairo.balart@metempsy.com * ARE_NS [5] 86013531Sjairo.balart@metempsy.com * affinity routing always on, no GICv2 legacy, RAO/WI 86113531Sjairo.balart@metempsy.com * ARE_S [4] 86213531Sjairo.balart@metempsy.com * affinity routing always on, no GICv2 legacy, RAO/WI 86313531Sjairo.balart@metempsy.com * EnableGrp1S [2] 86413531Sjairo.balart@metempsy.com * EnableGrp1NS [1] 86513531Sjairo.balart@metempsy.com * EnableGrp0 [0] 86613531Sjairo.balart@metempsy.com */ 86713531Sjairo.balart@metempsy.com if ((data & (1 << 5)) == 0) { 86813531Sjairo.balart@metempsy.com warn("Gicv3Distributor::write(): " 86913531Sjairo.balart@metempsy.com "setting ARE_NS to 0 is not supported!\n"); 87013531Sjairo.balart@metempsy.com } 87113531Sjairo.balart@metempsy.com 87213531Sjairo.balart@metempsy.com if ((data & (1 << 4)) == 0) { 87313531Sjairo.balart@metempsy.com warn("Gicv3Distributor::write(): " 87413531Sjairo.balart@metempsy.com "setting ARE_S to 0 is not supported!\n"); 87513531Sjairo.balart@metempsy.com } 87613531Sjairo.balart@metempsy.com 87713531Sjairo.balart@metempsy.com DS = data & GICD_CTLR_DS; 87813531Sjairo.balart@metempsy.com EnableGrp1S = data & GICD_CTLR_ENABLEGRP1S; 87913531Sjairo.balart@metempsy.com EnableGrp1NS = data & GICD_CTLR_ENABLEGRP1NS; 88013531Sjairo.balart@metempsy.com EnableGrp0 = data & GICD_CTLR_ENABLEGRP0; 88113531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): (DS 0 secure)" 88213531Sjairo.balart@metempsy.com "DS %d " 88313531Sjairo.balart@metempsy.com "EnableGrp1S %d EnableGrp1NS %d EnableGrp0 %d\n", 88413531Sjairo.balart@metempsy.com DS, EnableGrp1S, EnableGrp1NS, EnableGrp0); 88513531Sjairo.balart@metempsy.com 88613531Sjairo.balart@metempsy.com if (data & GICD_CTLR_DS) { 88713531Sjairo.balart@metempsy.com EnableGrp1S = 0; 88813531Sjairo.balart@metempsy.com } 88913531Sjairo.balart@metempsy.com } else { 89013531Sjairo.balart@metempsy.com /* 89113531Sjairo.balart@metempsy.com * ARE_NS [4] RAO/WI; 89213531Sjairo.balart@metempsy.com * EnableGrp1A [1] is a read-write alias of the Secure 89313531Sjairo.balart@metempsy.com * GICD_CTLR.EnableGrp1NS 89413531Sjairo.balart@metempsy.com * EnableGrp1 [0] RES0 89513531Sjairo.balart@metempsy.com */ 89613531Sjairo.balart@metempsy.com if ((data & (1 << 4)) == 0) { 89713531Sjairo.balart@metempsy.com warn("Gicv3Distributor::write(): " 89813531Sjairo.balart@metempsy.com "setting ARE_NS to 0 is not supported!\n"); 89913531Sjairo.balart@metempsy.com } 90013531Sjairo.balart@metempsy.com 90113531Sjairo.balart@metempsy.com EnableGrp1NS = data & GICD_CTLR_ENABLEGRP1A; 90213531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::write(): (DS 0 non-secure)" 90313531Sjairo.balart@metempsy.com "EnableGrp1NS %d\n", EnableGrp1NS); 90413531Sjairo.balart@metempsy.com } 90513531Sjairo.balart@metempsy.com } 90613531Sjairo.balart@metempsy.com 90713531Sjairo.balart@metempsy.com break; 90813531Sjairo.balart@metempsy.com 90913531Sjairo.balart@metempsy.com default: 91013531Sjairo.balart@metempsy.com panic("Gicv3Distributor::write(): invalid offset %#x\n", addr); 91113531Sjairo.balart@metempsy.com break; 91213531Sjairo.balart@metempsy.com } 91313531Sjairo.balart@metempsy.com} 91413531Sjairo.balart@metempsy.com 91513531Sjairo.balart@metempsy.comvoid 91613531Sjairo.balart@metempsy.comGicv3Distributor::sendInt(uint32_t int_id) 91713531Sjairo.balart@metempsy.com{ 91813531Sjairo.balart@metempsy.com panic_if(int_id < Gicv3::SGI_MAX + Gicv3::PPI_MAX, "Invalid SPI!"); 91913531Sjairo.balart@metempsy.com panic_if(int_id > itLines, "Invalid SPI!"); 92013531Sjairo.balart@metempsy.com irqPending[int_id] = true; 92113531Sjairo.balart@metempsy.com DPRINTF(GIC, "Gicv3Distributor::sendInt(): " 92213531Sjairo.balart@metempsy.com "int_id %d (SPI) pending bit set\n", int_id); 92313531Sjairo.balart@metempsy.com updateAndInformCPUInterfaces(); 92413531Sjairo.balart@metempsy.com} 92513531Sjairo.balart@metempsy.com 92613531Sjairo.balart@metempsy.comvoid 92713531Sjairo.balart@metempsy.comGicv3Distributor::intDeasserted(uint32_t int_id) 92813531Sjairo.balart@metempsy.com{ 92913531Sjairo.balart@metempsy.com panic_if(int_id < Gicv3::SGI_MAX + Gicv3::PPI_MAX, "Invalid SPI!"); 93013531Sjairo.balart@metempsy.com panic_if(int_id > itLines, "Invalid SPI!"); 93113531Sjairo.balart@metempsy.com irqPending[int_id] = false; 93213531Sjairo.balart@metempsy.com updateAndInformCPUInterfaces(); 93313531Sjairo.balart@metempsy.com} 93413531Sjairo.balart@metempsy.com 93513531Sjairo.balart@metempsy.comvoid 93613531Sjairo.balart@metempsy.comGicv3Distributor::updateAndInformCPUInterfaces() 93713531Sjairo.balart@metempsy.com{ 93813531Sjairo.balart@metempsy.com update(); 93913531Sjairo.balart@metempsy.com 94013531Sjairo.balart@metempsy.com for (int i = 0; i < gic->getSystem()->numContexts(); i++) { 94113531Sjairo.balart@metempsy.com gic->getCPUInterface(i)->update(); 94213531Sjairo.balart@metempsy.com } 94313531Sjairo.balart@metempsy.com} 94413531Sjairo.balart@metempsy.com 94513531Sjairo.balart@metempsy.comvoid 94613531Sjairo.balart@metempsy.comGicv3Distributor::fullUpdate() 94713531Sjairo.balart@metempsy.com{ 94813531Sjairo.balart@metempsy.com for (int i = 0; i < gic->getSystem()->numContexts(); i++) { 94913531Sjairo.balart@metempsy.com Gicv3CPUInterface * cpu_interface_i = gic->getCPUInterface(i); 95013531Sjairo.balart@metempsy.com cpu_interface_i->hppi.prio = 0xff; 95113531Sjairo.balart@metempsy.com } 95213531Sjairo.balart@metempsy.com 95313531Sjairo.balart@metempsy.com update(); 95413531Sjairo.balart@metempsy.com 95513531Sjairo.balart@metempsy.com for (int i = 0; i < gic->getSystem()->numContexts(); i++) { 95613531Sjairo.balart@metempsy.com Gicv3Redistributor * redistributor_i = gic->getRedistributor(i); 95713531Sjairo.balart@metempsy.com redistributor_i->update(); 95813531Sjairo.balart@metempsy.com } 95913531Sjairo.balart@metempsy.com} 96013531Sjairo.balart@metempsy.com 96113531Sjairo.balart@metempsy.comvoid 96213531Sjairo.balart@metempsy.comGicv3Distributor::update() 96313531Sjairo.balart@metempsy.com{ 96413531Sjairo.balart@metempsy.com std::vector<bool> new_hppi(gic->getSystem()->numContexts(), false); 96513531Sjairo.balart@metempsy.com 96613531Sjairo.balart@metempsy.com // Find the highest priority pending SPI 96713531Sjairo.balart@metempsy.com for (int int_id = Gicv3::SGI_MAX + Gicv3::PPI_MAX; int_id < itLines; 96813531Sjairo.balart@metempsy.com int_id++) { 96913531Sjairo.balart@metempsy.com Gicv3::GroupId int_group = getIntGroup(int_id); 97013531Sjairo.balart@metempsy.com bool group_enabled = groupEnabled(int_group); 97113531Sjairo.balart@metempsy.com 97213531Sjairo.balart@metempsy.com if (irqPending[int_id] && irqEnabled[int_id] && 97313531Sjairo.balart@metempsy.com !irqActive[int_id] && group_enabled) { 97413531Sjairo.balart@metempsy.com IROUTER affinity_routing = irqAffinityRouting[int_id]; 97513531Sjairo.balart@metempsy.com Gicv3Redistributor * target_redistributor = nullptr; 97613531Sjairo.balart@metempsy.com 97713531Sjairo.balart@metempsy.com if (affinity_routing.IRM) { 97813531Sjairo.balart@metempsy.com // Interrupts routed to any PE defined as a participating node 97913531Sjairo.balart@metempsy.com for (int i = 0; i < gic->getSystem()->numContexts(); i++) { 98013531Sjairo.balart@metempsy.com Gicv3Redistributor * redistributor_i = 98113531Sjairo.balart@metempsy.com gic->getRedistributor(i); 98213531Sjairo.balart@metempsy.com 98313531Sjairo.balart@metempsy.com if (redistributor_i-> 98413531Sjairo.balart@metempsy.com canBeSelectedFor1toNInterrupt(int_group)) { 98513531Sjairo.balart@metempsy.com target_redistributor = redistributor_i; 98613531Sjairo.balart@metempsy.com break; 98713531Sjairo.balart@metempsy.com } 98813531Sjairo.balart@metempsy.com } 98913531Sjairo.balart@metempsy.com } else { 99013531Sjairo.balart@metempsy.com uint32_t affinity = (affinity_routing.Aff3 << 24) | 99113531Sjairo.balart@metempsy.com (affinity_routing.Aff3 << 16) | 99213531Sjairo.balart@metempsy.com (affinity_routing.Aff1 << 8) | 99313531Sjairo.balart@metempsy.com (affinity_routing.Aff0 << 0); 99413531Sjairo.balart@metempsy.com target_redistributor = 99513531Sjairo.balart@metempsy.com gic->getRedistributorByAffinity(affinity); 99613531Sjairo.balart@metempsy.com } 99713531Sjairo.balart@metempsy.com 99813531Sjairo.balart@metempsy.com if (!target_redistributor) { 99913531Sjairo.balart@metempsy.com // Interrrupts targeting not present cpus must remain pending 100013531Sjairo.balart@metempsy.com return; 100113531Sjairo.balart@metempsy.com } 100213531Sjairo.balart@metempsy.com 100313531Sjairo.balart@metempsy.com Gicv3CPUInterface * target_cpu_interface = 100413531Sjairo.balart@metempsy.com target_redistributor->getCPUInterface(); 100513531Sjairo.balart@metempsy.com uint32_t target_cpu = target_redistributor->cpuId; 100613531Sjairo.balart@metempsy.com 100713531Sjairo.balart@metempsy.com if ((irqPriority[int_id] < target_cpu_interface->hppi.prio) || 100813531Sjairo.balart@metempsy.com /* 100913531Sjairo.balart@metempsy.com * Multiple pending ints with same priority. 101013531Sjairo.balart@metempsy.com * Implementation choice which one to signal. 101113531Sjairo.balart@metempsy.com * Our implementation selects the one with the lower id. 101213531Sjairo.balart@metempsy.com */ 101313531Sjairo.balart@metempsy.com (irqPriority[int_id] == target_cpu_interface->hppi.prio && 101413531Sjairo.balart@metempsy.com int_id < target_cpu_interface->hppi.intid)) { 101513531Sjairo.balart@metempsy.com target_cpu_interface->hppi.intid = int_id; 101613531Sjairo.balart@metempsy.com target_cpu_interface->hppi.prio = irqPriority[int_id]; 101713531Sjairo.balart@metempsy.com target_cpu_interface->hppi.group = int_group; 101813531Sjairo.balart@metempsy.com new_hppi[target_cpu] = true; 101913531Sjairo.balart@metempsy.com } 102013531Sjairo.balart@metempsy.com } 102113531Sjairo.balart@metempsy.com } 102213531Sjairo.balart@metempsy.com 102313531Sjairo.balart@metempsy.com for (int i = 0; i < gic->getSystem()->numContexts(); i++) { 102413531Sjairo.balart@metempsy.com Gicv3Redistributor * redistributor_i = gic->getRedistributor(i); 102513531Sjairo.balart@metempsy.com Gicv3CPUInterface * cpu_interface_i = 102613531Sjairo.balart@metempsy.com redistributor_i->getCPUInterface(); 102713531Sjairo.balart@metempsy.com 102813531Sjairo.balart@metempsy.com if (!new_hppi[i] && cpu_interface_i->hppi.prio != 0xff && 102913531Sjairo.balart@metempsy.com cpu_interface_i->hppi.intid >= 103013531Sjairo.balart@metempsy.com (Gicv3::SGI_MAX + Gicv3::PPI_MAX) && 103113531Sjairo.balart@metempsy.com cpu_interface_i->hppi.intid < Gicv3::INTID_SECURE) { 103213531Sjairo.balart@metempsy.com fullUpdate(); 103313531Sjairo.balart@metempsy.com } 103413531Sjairo.balart@metempsy.com } 103513531Sjairo.balart@metempsy.com} 103613531Sjairo.balart@metempsy.com 103713531Sjairo.balart@metempsy.comGicv3::IntStatus 103813531Sjairo.balart@metempsy.comGicv3Distributor::intStatus(uint32_t int_id) 103913531Sjairo.balart@metempsy.com{ 104013531Sjairo.balart@metempsy.com panic_if(int_id < Gicv3::SGI_MAX + Gicv3::PPI_MAX, "Invalid SPI!"); 104113531Sjairo.balart@metempsy.com panic_if(int_id > itLines, "Invalid SPI!"); 104213531Sjairo.balart@metempsy.com 104313531Sjairo.balart@metempsy.com if (irqPending[int_id]) { 104413531Sjairo.balart@metempsy.com if (irqActive[int_id]) { 104513531Sjairo.balart@metempsy.com return Gicv3::INT_ACTIVE_PENDING; 104613531Sjairo.balart@metempsy.com } 104713531Sjairo.balart@metempsy.com 104813531Sjairo.balart@metempsy.com return Gicv3::INT_PENDING; 104913531Sjairo.balart@metempsy.com } else if (irqActive[int_id]) { 105013531Sjairo.balart@metempsy.com return Gicv3::INT_ACTIVE; 105113531Sjairo.balart@metempsy.com } else { 105213531Sjairo.balart@metempsy.com return Gicv3::INT_INACTIVE; 105313531Sjairo.balart@metempsy.com } 105413531Sjairo.balart@metempsy.com} 105513531Sjairo.balart@metempsy.com 105613531Sjairo.balart@metempsy.comGicv3::GroupId 105713531Sjairo.balart@metempsy.comGicv3Distributor::getIntGroup(int int_id) 105813531Sjairo.balart@metempsy.com{ 105913531Sjairo.balart@metempsy.com panic_if(int_id < Gicv3::SGI_MAX + Gicv3::PPI_MAX, "Invalid SPI!"); 106013531Sjairo.balart@metempsy.com panic_if(int_id > itLines, "Invalid SPI!"); 106113531Sjairo.balart@metempsy.com 106213531Sjairo.balart@metempsy.com if (DS) { 106313531Sjairo.balart@metempsy.com if (irqGroup[int_id] == 1) { 106413531Sjairo.balart@metempsy.com return Gicv3::G1NS; 106513531Sjairo.balart@metempsy.com } else { 106613531Sjairo.balart@metempsy.com return Gicv3::G0S; 106713531Sjairo.balart@metempsy.com } 106813531Sjairo.balart@metempsy.com } else { 106913531Sjairo.balart@metempsy.com if (irqGrpmod[int_id] == 0 && irqGroup[int_id] == 0) { 107013531Sjairo.balart@metempsy.com return Gicv3::G0S; 107113531Sjairo.balart@metempsy.com } else if (irqGrpmod[int_id] == 0 && irqGroup[int_id] == 1) { 107213531Sjairo.balart@metempsy.com return Gicv3::G1NS; 107313531Sjairo.balart@metempsy.com } else if (irqGrpmod[int_id] == 1 && irqGroup[int_id] == 0) { 107413531Sjairo.balart@metempsy.com return Gicv3::G1S; 107513531Sjairo.balart@metempsy.com } else if (irqGrpmod[int_id] == 1 && irqGroup[int_id] == 1) { 107613531Sjairo.balart@metempsy.com return Gicv3::G1NS; 107713531Sjairo.balart@metempsy.com } 107813531Sjairo.balart@metempsy.com } 107913531Sjairo.balart@metempsy.com 108013531Sjairo.balart@metempsy.com M5_UNREACHABLE; 108113531Sjairo.balart@metempsy.com} 108213531Sjairo.balart@metempsy.com 108313531Sjairo.balart@metempsy.comvoid 108413531Sjairo.balart@metempsy.comGicv3Distributor::activateIRQ(uint32_t int_id) 108513531Sjairo.balart@metempsy.com{ 108613531Sjairo.balart@metempsy.com irqPending[int_id] = false; 108713531Sjairo.balart@metempsy.com irqActive[int_id] = true; 108813531Sjairo.balart@metempsy.com} 108913531Sjairo.balart@metempsy.com 109013531Sjairo.balart@metempsy.comvoid 109113531Sjairo.balart@metempsy.comGicv3Distributor::deactivateIRQ(uint32_t int_id) 109213531Sjairo.balart@metempsy.com{ 109313531Sjairo.balart@metempsy.com irqActive[int_id] = false; 109413531Sjairo.balart@metempsy.com} 109513531Sjairo.balart@metempsy.com 109613531Sjairo.balart@metempsy.comvoid 109713531Sjairo.balart@metempsy.comGicv3Distributor::serialize(CheckpointOut & cp) const 109813531Sjairo.balart@metempsy.com{ 109913531Sjairo.balart@metempsy.com SERIALIZE_SCALAR(ARE); 110013531Sjairo.balart@metempsy.com SERIALIZE_SCALAR(DS); 110113531Sjairo.balart@metempsy.com SERIALIZE_SCALAR(EnableGrp1S); 110213531Sjairo.balart@metempsy.com SERIALIZE_SCALAR(EnableGrp1NS); 110313531Sjairo.balart@metempsy.com SERIALIZE_SCALAR(EnableGrp0); 110413531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqGroup); 110513531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqEnabled); 110613531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqPending); 110713531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqActive); 110813531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqPriority); 110913531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqConfig); 111013531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqGrpmod); 111113531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqNsacr); 111213531Sjairo.balart@metempsy.com SERIALIZE_CONTAINER(irqAffinityRouting); 111313531Sjairo.balart@metempsy.com} 111413531Sjairo.balart@metempsy.com 111513531Sjairo.balart@metempsy.comvoid 111613531Sjairo.balart@metempsy.comGicv3Distributor::unserialize(CheckpointIn & cp) 111713531Sjairo.balart@metempsy.com{ 111813531Sjairo.balart@metempsy.com UNSERIALIZE_SCALAR(ARE); 111913531Sjairo.balart@metempsy.com UNSERIALIZE_SCALAR(DS); 112013531Sjairo.balart@metempsy.com UNSERIALIZE_SCALAR(EnableGrp1S); 112113531Sjairo.balart@metempsy.com UNSERIALIZE_SCALAR(EnableGrp1NS); 112213531Sjairo.balart@metempsy.com UNSERIALIZE_SCALAR(EnableGrp0); 112313531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqGroup); 112413531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqEnabled); 112513531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqPending); 112613531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqActive); 112713531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqPriority); 112813531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqConfig); 112913531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqGrpmod); 113013531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqNsacr); 113113531Sjairo.balart@metempsy.com UNSERIALIZE_CONTAINER(irqAffinityRouting); 113213531Sjairo.balart@metempsy.com} 1133