arch-arm: Revamp takeInt to take VHE/SEL2 into account

The new implementation matches the table in the ARM Architecture
Reference Manual (version DDI 0487J.a, section D1.3.6, table R_SXLWJ)

It takes into consideration features like FEAT_SEL2 (scr.eel2 bit) and
FEAT_VHE (hcr.e2h bit) which affect the masking of interrupts under
certain circumstances

Signed-off-by: Giacomo Travaglini <giacomo.travaglini@arm.com>
Change-Id: I07ebd8d859651475bd32fd201eea0f4e64a7dd5f
This commit is contained in:
Giacomo Travaglini
2023-06-01 15:20:50 +01:00
parent e412ddddbd
commit 8acf49b6fa

View File

@@ -1,5 +1,5 @@
/*
* Copyright (c) 2009, 2012-2013, 2016, 2019 ARM Limited
* Copyright (c) 2009, 2012-2013, 2016, 2019, 2023 Arm Limited
* All rights reserved.
*
* The license below extends only to copyright in the software and shall
@@ -113,7 +113,7 @@ ArmISA::Interrupts::takeInt64(InterruptTypes int_type) const
HCR hcr = tc->readMiscReg(MISCREG_HCR_EL2);
ExceptionLevel el = currEL(tc);
bool cpsr_mask_bit, scr_routing_bit, hcr_mask_override_bit;
bool is_secure = isSecure(tc);
bool is_secure = isSecureBelowEL3(tc);
switch(int_type) {
case INT_FIQ:
@@ -135,48 +135,141 @@ ArmISA::Interrupts::takeInt64(InterruptTypes int_type) const
panic("Unhandled interrupt type!");
}
if (hcr.tge)
hcr_mask_override_bit = 1;
if (!scr_routing_bit) {
// SCR IRQ == 0
if (!scr.rw) {
// SCR RW == 0
if (!hcr_mask_override_bit) {
if (is_secure) {
if (!scr.eel2) {
if (!scr_routing_bit) {
// NS=0,EEL2=0,EAI/IRQ/FIQ=0
if (el == EL3)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
} else {
// NS=0,EEL2=0,EAI/IRQ/FIQ=1
if (el == EL3)
mask = INT_MASK_T;
else if (is_secure || el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
} else {
// SCR RW == 1
if (!hcr_mask_override_bit) {
if (el == EL3 || el == EL2)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
if (!scr_routing_bit) {
if (!hcr.tge) {
if (!hcr_mask_override_bit) {
// NS=0,EEL2=1,EAI/IRQ/FIQ=0,TGE=0,AMO/IMO/FMO=0
if (el == EL3 || el == EL2)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
} else {
// NS=0,EEL2=1,EAI/IRQ/FIQ=0,TGE=0,AMO/IMO/FMO=1
if (el == EL3)
mask = INT_MASK_P;
else if (el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
} else {
if (!hcr.e2h) {
// NS=0,EEL2=1,EAI/IRQ/FIQ=0,TGE=1,E2H=0
if (el == EL3)
mask = INT_MASK_P;
else if (el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
} else {
// NS=0,EEL2=1,EAI/IRQ/FIQ=0,TGE=1,E2H=1
if (el == EL3)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
}
}
} else {
if (el == EL3)
mask = INT_MASK_P;
else if (is_secure || el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
if (!hcr.tge) {
// NS=0,EEL2=1,EAI/IRQ/FIQ=1,TGE=0
if (el == EL3)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
} else {
// NS=0,EEL2=1,EAI/IRQ/FIQ=1,TGE=1
if (el == EL3)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
}
}
} else {
// SCR IRQ == 1
if (el == EL3)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
if (!scr_routing_bit) {
if (!scr.rw) {
if (!hcr.tge) {
if (!hcr_mask_override_bit) {
// NS=1,EAI/IRQ/FIQ=0,RW=0,TGE=0,AMO/IMO?/FMO=0
if (el == EL3)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
} else {
// NS=1,EAI/IRQ/FIQ=0,RW=0,TGE=0,AMO/IMO?/FMO=1
if (el == EL3)
mask = INT_MASK_P;
else if (el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
} else {
// NS=1,EAI/IRQ/FIQ=0,RW=0,TGE=1
if (el == EL3)
mask = INT_MASK_P;
else if (el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
} else {
if (!hcr.tge) {
if (!hcr_mask_override_bit) {
// NS=1,EAI/IRQ/FIQ=0,RW=1,TGE=0,AMO/IMO/FMO=0
if (el == EL3 || el == EL2)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
} else {
// NS=1,EAI/IRQ/FIQ=0,RW=1,TGE=0,AMO/IMO/FMO=1
if (el == EL3)
mask = INT_MASK_P;
else if (el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
} else {
if (!hcr.e2h) {
// NS=1,EAI/IRQ/FIQ=0,RW=1,TGE=1,E2H=0
if (el == EL3)
mask = INT_MASK_P;
else if (el == EL2)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
} else {
// NS=1,EAI/IRQ/FIQ=0,RW=1,TGE=1,E2H=1
if (el == EL3)
mask = INT_MASK_P;
else
mask = INT_MASK_M;
}
}
}
} else {
if (el == EL3)
mask = INT_MASK_M;
else
mask = INT_MASK_T;
}
}
return ((mask == INT_MASK_T) ||
((mask == INT_MASK_M) && !cpsr_mask_bit)) &&