16a0da736SJayanth Dodderi Chidanand /* 2b0b7609eSBoyan Karatotev * Copyright (c) 2022-2025, Arm Limited and Contributors. All rights reserved. 36a0da736SJayanth Dodderi Chidanand * 46a0da736SJayanth Dodderi Chidanand * SPDX-License-Identifier: BSD-3-Clause 56a0da736SJayanth Dodderi Chidanand */ 66a0da736SJayanth Dodderi Chidanand 769c17f52SAndre Przywara #include <arch_features.h> 869c17f52SAndre Przywara #include <common/debug.h> 96a0da736SJayanth Dodderi Chidanand #include <common/feat_detect.h> 10d335bbb1SBoyan Karatotev #include <plat/common/platform.h> 116a0da736SJayanth Dodderi Chidanand 12d335bbb1SBoyan Karatotev static bool detection_done[PLATFORM_CORE_COUNT] = { false }; 13b45dd74eSAndre Przywara 146a0da736SJayanth Dodderi Chidanand /******************************************************************************* 156a0da736SJayanth Dodderi Chidanand * This section lists the wrapper modules for each feature to evaluate the 1669c17f52SAndre Przywara * feature states (FEAT_STATE_ALWAYS and FEAT_STATE_CHECK) and perform 1769c17f52SAndre Przywara * necessary action as below: 186a0da736SJayanth Dodderi Chidanand * 196a0da736SJayanth Dodderi Chidanand * It verifies whether the FEAT_XXX (eg: FEAT_SB) is supported by the PE or not. 206a0da736SJayanth Dodderi Chidanand * Without this check an exception would occur during context save/restore 216a0da736SJayanth Dodderi Chidanand * routines, if the feature is enabled but not supported by PE. 226a0da736SJayanth Dodderi Chidanand ******************************************************************************/ 236a0da736SJayanth Dodderi Chidanand 2469c17f52SAndre Przywara #define feat_detect_panic(a, b) ((a) ? (void)0 : feature_panic(b)) 2569c17f52SAndre Przywara 2669c17f52SAndre Przywara /******************************************************************************* 2769c17f52SAndre Przywara * Function : feature_panic 2869c17f52SAndre Przywara * Customised panic function with error logging mechanism to list the feature 2969c17f52SAndre Przywara * not supported by the PE. 3069c17f52SAndre Przywara ******************************************************************************/ 3169c17f52SAndre Przywara static inline void feature_panic(char *feat_name) 3269c17f52SAndre Przywara { 3369c17f52SAndre Przywara ERROR("FEAT_%s not supported by the PE\n", feat_name); 3469c17f52SAndre Przywara panic(); 3569c17f52SAndre Przywara } 3669c17f52SAndre Przywara 37b45dd74eSAndre Przywara /******************************************************************************* 38b45dd74eSAndre Przywara * Function : check_feature 39b45dd74eSAndre Przywara * Check for a valid combination of build time flags (ENABLE_FEAT_xxx) and 40a4cccb4fSAndre Przywara * feature availability on the hardware. <min> is the smallest feature 41a4cccb4fSAndre Przywara * ID field value that is required for that feature. 42a4cccb4fSAndre Przywara * Triggers a panic later if a feature is forcefully enabled, but not 43a4cccb4fSAndre Przywara * available on the PE. Also will panic if the hardware feature ID field 44a4cccb4fSAndre Przywara * is larger than the maximum known and supported number, specified by <max>. 45b45dd74eSAndre Przywara * 46b45dd74eSAndre Przywara * We force inlining here to let the compiler optimise away the whole check 47b45dd74eSAndre Przywara * if the feature is disabled at build time (FEAT_STATE_DISABLED). 48b45dd74eSAndre Przywara ******************************************************************************/ 49d335bbb1SBoyan Karatotev static inline bool __attribute((__always_inline__)) 50a4cccb4fSAndre Przywara check_feature(int state, unsigned long field, const char *feat_name, 51a4cccb4fSAndre Przywara unsigned int min, unsigned int max) 52b45dd74eSAndre Przywara { 53a4cccb4fSAndre Przywara if (state == FEAT_STATE_ALWAYS && field < min) { 54b45dd74eSAndre Przywara ERROR("FEAT_%s not supported by the PE\n", feat_name); 55d335bbb1SBoyan Karatotev return true; 56b45dd74eSAndre Przywara } 57a4cccb4fSAndre Przywara if (state >= FEAT_STATE_ALWAYS && field > max) { 58a4cccb4fSAndre Przywara ERROR("FEAT_%s is version %ld, but is only known up to version %d\n", 59a4cccb4fSAndre Przywara feat_name, field, max); 60d335bbb1SBoyan Karatotev return true; 61a4cccb4fSAndre Przywara } 62d335bbb1SBoyan Karatotev 63d335bbb1SBoyan Karatotev return false; 64b45dd74eSAndre Przywara } 65b45dd74eSAndre Przywara 66011829b3SSona Mathew static unsigned int read_feat_rng_trap_id_field(void) 676a0da736SJayanth Dodderi Chidanand { 68011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_RNDR_TRAP_SHIFT, 69011829b3SSona Mathew ID_AA64PFR1_EL1_RNDR_TRAP_MASK); 706a0da736SJayanth Dodderi Chidanand } 716a0da736SJayanth Dodderi Chidanand 72011829b3SSona Mathew static unsigned int read_feat_bti_id_field(void) 736a0da736SJayanth Dodderi Chidanand { 74011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_BT_SHIFT, 75011829b3SSona Mathew ID_AA64PFR1_EL1_BT_MASK); 766a0da736SJayanth Dodderi Chidanand } 776a0da736SJayanth Dodderi Chidanand 78011829b3SSona Mathew static unsigned int read_feat_sb_id_field(void) 79ff86e0b4SJuan Pablo Conde { 80011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64isar1_el1(), ID_AA64ISAR1_SB_SHIFT, 81011829b3SSona Mathew ID_AA64ISAR1_SB_MASK); 82011829b3SSona Mathew } 83011829b3SSona Mathew 84011829b3SSona Mathew static unsigned int read_feat_csv2_id_field(void) 85011829b3SSona Mathew { 86011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_CSV2_SHIFT, 87011829b3SSona Mathew ID_AA64PFR0_CSV2_MASK); 88011829b3SSona Mathew } 89011829b3SSona Mathew 9083271d5aSArvind Ram Prakash static unsigned int read_feat_debugv8p9_id_field(void) 9183271d5aSArvind Ram Prakash { 9283271d5aSArvind Ram Prakash return ISOLATE_FIELD(read_id_aa64dfr0_el1(), ID_AA64DFR0_DEBUGVER_SHIFT, 9383271d5aSArvind Ram Prakash ID_AA64DFR0_DEBUGVER_MASK); 9483271d5aSArvind Ram Prakash } 9583271d5aSArvind Ram Prakash 96011829b3SSona Mathew static unsigned int read_feat_pmuv3_id_field(void) 97011829b3SSona Mathew { 98011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64dfr0_el1(), ID_AA64DFR0_PMUVER_SHIFT, 99011829b3SSona Mathew ID_AA64DFR0_PMUVER_MASK); 100011829b3SSona Mathew } 101011829b3SSona Mathew 102011829b3SSona Mathew static unsigned int read_feat_vhe_id_field(void) 103011829b3SSona Mathew { 104011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr1_el1(), ID_AA64MMFR1_EL1_VHE_SHIFT, 105011829b3SSona Mathew ID_AA64MMFR1_EL1_VHE_MASK); 106011829b3SSona Mathew } 107011829b3SSona Mathew 108011829b3SSona Mathew static unsigned int read_feat_sve_id_field(void) 109011829b3SSona Mathew { 110011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_SVE_SHIFT, 111011829b3SSona Mathew ID_AA64PFR0_SVE_MASK); 112011829b3SSona Mathew } 113011829b3SSona Mathew 114011829b3SSona Mathew static unsigned int read_feat_ras_id_field(void) 115011829b3SSona Mathew { 116011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_RAS_SHIFT, 117011829b3SSona Mathew ID_AA64PFR0_RAS_MASK); 118011829b3SSona Mathew } 119011829b3SSona Mathew 120011829b3SSona Mathew static unsigned int read_feat_dit_id_field(void) 121011829b3SSona Mathew { 122011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_DIT_SHIFT, 123011829b3SSona Mathew ID_AA64PFR0_DIT_MASK); 124011829b3SSona Mathew } 125011829b3SSona Mathew 126011829b3SSona Mathew static unsigned int read_feat_amu_id_field(void) 127011829b3SSona Mathew { 128011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_AMU_SHIFT, 129011829b3SSona Mathew ID_AA64PFR0_AMU_MASK); 130011829b3SSona Mathew } 131011829b3SSona Mathew 132011829b3SSona Mathew static unsigned int read_feat_mpam_version(void) 133011829b3SSona Mathew { 134011829b3SSona Mathew return (unsigned int)((((read_id_aa64pfr0_el1() >> 135011829b3SSona Mathew ID_AA64PFR0_MPAM_SHIFT) & ID_AA64PFR0_MPAM_MASK) << 4) | 136011829b3SSona Mathew ((read_id_aa64pfr1_el1() >> 137011829b3SSona Mathew ID_AA64PFR1_MPAM_FRAC_SHIFT) & ID_AA64PFR1_MPAM_FRAC_MASK)); 138011829b3SSona Mathew } 139011829b3SSona Mathew 140011829b3SSona Mathew static unsigned int read_feat_nv_id_field(void) 141011829b3SSona Mathew { 142011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr2_el1(), ID_AA64MMFR2_EL1_NV_SHIFT, 143011829b3SSona Mathew ID_AA64MMFR2_EL1_NV_MASK); 144011829b3SSona Mathew } 145011829b3SSona Mathew 146011829b3SSona Mathew static unsigned int read_feat_sel2_id_field(void) 147011829b3SSona Mathew { 148011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_SEL2_SHIFT, 149011829b3SSona Mathew ID_AA64PFR0_SEL2_MASK); 150011829b3SSona Mathew } 151011829b3SSona Mathew 152011829b3SSona Mathew static unsigned int read_feat_trf_id_field(void) 153011829b3SSona Mathew { 154011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64dfr0_el1(), ID_AA64DFR0_TRACEFILT_SHIFT, 155011829b3SSona Mathew ID_AA64DFR0_TRACEFILT_MASK); 156011829b3SSona Mathew } 157011829b3SSona Mathew static unsigned int get_armv8_5_mte_support(void) 158011829b3SSona Mathew { 159011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_MTE_SHIFT, 160011829b3SSona Mathew ID_AA64PFR1_EL1_MTE_MASK); 161011829b3SSona Mathew } 162011829b3SSona Mathew static unsigned int read_feat_rng_id_field(void) 163011829b3SSona Mathew { 164011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64isar0_el1(), ID_AA64ISAR0_RNDR_SHIFT, 165011829b3SSona Mathew ID_AA64ISAR0_RNDR_MASK); 166011829b3SSona Mathew } 167011829b3SSona Mathew static unsigned int read_feat_fgt_id_field(void) 168011829b3SSona Mathew { 169011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr0_el1(), ID_AA64MMFR0_EL1_FGT_SHIFT, 170011829b3SSona Mathew ID_AA64MMFR0_EL1_FGT_MASK); 171011829b3SSona Mathew } 172011829b3SSona Mathew static unsigned int read_feat_ecv_id_field(void) 173011829b3SSona Mathew { 174011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr0_el1(), ID_AA64MMFR0_EL1_ECV_SHIFT, 175011829b3SSona Mathew ID_AA64MMFR0_EL1_ECV_MASK); 176011829b3SSona Mathew } 177011829b3SSona Mathew static unsigned int read_feat_twed_id_field(void) 178011829b3SSona Mathew { 179011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr1_el1(), ID_AA64MMFR1_EL1_TWED_SHIFT, 180011829b3SSona Mathew ID_AA64MMFR1_EL1_TWED_MASK); 181011829b3SSona Mathew } 182011829b3SSona Mathew 183011829b3SSona Mathew static unsigned int read_feat_hcx_id_field(void) 184011829b3SSona Mathew { 185011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr1_el1(), ID_AA64MMFR1_EL1_HCX_SHIFT, 186011829b3SSona Mathew ID_AA64MMFR1_EL1_HCX_MASK); 187011829b3SSona Mathew } 18819d52a83SAndre Przywara static unsigned int read_feat_ls64_id_field(void) 18919d52a83SAndre Przywara { 19019d52a83SAndre Przywara return ISOLATE_FIELD(read_id_aa64isar1_el1(), ID_AA64ISAR1_LS64_SHIFT, 19119d52a83SAndre Przywara ID_AA64ISAR1_LS64_MASK); 19219d52a83SAndre Przywara } 193cc2523bbSAndre Przywara static unsigned int read_feat_aie_id_field(void) 194cc2523bbSAndre Przywara { 195cc2523bbSAndre Przywara return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_AIE_SHIFT, 196cc2523bbSAndre Przywara ID_AA64MMFR3_EL1_AIE_MASK); 197cc2523bbSAndre Przywara } 198b3bcfd12SAndre Przywara static unsigned int read_feat_pfar_id_field(void) 199b3bcfd12SAndre Przywara { 200b3bcfd12SAndre Przywara return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_PFAR_SHIFT, 201b3bcfd12SAndre Przywara ID_AA64PFR1_EL1_PFAR_MASK); 202b3bcfd12SAndre Przywara } 203011829b3SSona Mathew static unsigned int read_feat_tcr2_id_field(void) 204011829b3SSona Mathew { 205011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_TCRX_SHIFT, 206011829b3SSona Mathew ID_AA64MMFR3_EL1_TCRX_MASK); 207011829b3SSona Mathew } 208011829b3SSona Mathew static unsigned int read_feat_s2pie_id_field(void) 209011829b3SSona Mathew { 210011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_S2PIE_SHIFT, 211011829b3SSona Mathew ID_AA64MMFR3_EL1_S2PIE_MASK); 212011829b3SSona Mathew } 213011829b3SSona Mathew static unsigned int read_feat_s1pie_id_field(void) 214011829b3SSona Mathew { 215011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_S1PIE_SHIFT, 216011829b3SSona Mathew ID_AA64MMFR3_EL1_S1PIE_MASK); 217011829b3SSona Mathew } 218011829b3SSona Mathew static unsigned int read_feat_s2poe_id_field(void) 219011829b3SSona Mathew { 220011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_S2POE_SHIFT, 221011829b3SSona Mathew ID_AA64MMFR3_EL1_S2POE_MASK); 222011829b3SSona Mathew } 223011829b3SSona Mathew static unsigned int read_feat_s1poe_id_field(void) 224011829b3SSona Mathew { 225011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_S1POE_SHIFT, 226011829b3SSona Mathew ID_AA64MMFR3_EL1_S1POE_MASK); 227011829b3SSona Mathew } 228011829b3SSona Mathew static unsigned int read_feat_brbe_id_field(void) 229011829b3SSona Mathew { 230011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64dfr0_el1(), ID_AA64DFR0_BRBE_SHIFT, 231011829b3SSona Mathew ID_AA64DFR0_BRBE_MASK); 232011829b3SSona Mathew } 233011829b3SSona Mathew static unsigned int read_feat_trbe_id_field(void) 234011829b3SSona Mathew { 235011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64dfr0_el1(), ID_AA64DFR0_TRACEBUFFER_SHIFT, 236011829b3SSona Mathew ID_AA64DFR0_TRACEBUFFER_MASK); 237011829b3SSona Mathew } 238011829b3SSona Mathew static unsigned int read_feat_sme_id_field(void) 239011829b3SSona Mathew { 240011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_SME_SHIFT, 241011829b3SSona Mathew ID_AA64PFR1_EL1_SME_MASK); 242011829b3SSona Mathew } 243011829b3SSona Mathew static unsigned int read_feat_gcs_id_field(void) 244011829b3SSona Mathew { 245011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_GCS_SHIFT, 246011829b3SSona Mathew ID_AA64PFR1_EL1_GCS_MASK); 247011829b3SSona Mathew } 248011829b3SSona Mathew 249011829b3SSona Mathew static unsigned int read_feat_rme_id_field(void) 250011829b3SSona Mathew { 251011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64pfr0_el1(), ID_AA64PFR0_FEAT_RME_SHIFT, 252011829b3SSona Mathew ID_AA64PFR0_FEAT_RME_MASK); 253011829b3SSona Mathew } 254011829b3SSona Mathew 255011829b3SSona Mathew static unsigned int read_feat_pan_id_field(void) 256011829b3SSona Mathew { 257011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64mmfr1_el1(), ID_AA64MMFR1_EL1_PAN_SHIFT, 258011829b3SSona Mathew ID_AA64MMFR1_EL1_PAN_MASK); 259011829b3SSona Mathew } 260011829b3SSona Mathew 261011829b3SSona Mathew static unsigned int read_feat_mtpmu_id_field(void) 262011829b3SSona Mathew { 263011829b3SSona Mathew return ISOLATE_FIELD(read_id_aa64dfr0_el1(), ID_AA64DFR0_MTPMU_SHIFT, 264011829b3SSona Mathew ID_AA64DFR0_MTPMU_MASK); 265011829b3SSona Mathew 266ff86e0b4SJuan Pablo Conde } 267ff86e0b4SJuan Pablo Conde 2686d0433f0SJayanth Dodderi Chidanand static unsigned int read_feat_the_id_field(void) 2696d0433f0SJayanth Dodderi Chidanand { 2706d0433f0SJayanth Dodderi Chidanand return ISOLATE_FIELD(read_id_aa64pfr1_el1(), ID_AA64PFR1_EL1_THE_SHIFT, 2716d0433f0SJayanth Dodderi Chidanand ID_AA64PFR1_EL1_THE_MASK); 2726d0433f0SJayanth Dodderi Chidanand } 2736d0433f0SJayanth Dodderi Chidanand 2744ec4e545SJayanth Dodderi Chidanand static unsigned int read_feat_sctlr2_id_field(void) 2754ec4e545SJayanth Dodderi Chidanand { 2764ec4e545SJayanth Dodderi Chidanand return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_SCTLR2_SHIFT, 2774ec4e545SJayanth Dodderi Chidanand ID_AA64MMFR3_EL1_SCTLR2_MASK); 2784ec4e545SJayanth Dodderi Chidanand } 2794ec4e545SJayanth Dodderi Chidanand 28030655136SGovindraj Raja static unsigned int read_feat_d128_id_field(void) 28130655136SGovindraj Raja { 28230655136SGovindraj Raja return ISOLATE_FIELD(read_id_aa64mmfr3_el1(), ID_AA64MMFR3_EL1_D128_SHIFT, 28330655136SGovindraj Raja ID_AA64MMFR3_EL1_D128_MASK); 28430655136SGovindraj Raja } 2858cef63d6SBoyan Karatotev static unsigned int read_feat_gcie_id_field(void) 2868cef63d6SBoyan Karatotev { 2878cef63d6SBoyan Karatotev return ISOLATE_FIELD(read_id_aa64pfr2_el1(), ID_AA64PFR2_EL1_GCIE_SHIFT, 2888cef63d6SBoyan Karatotev ID_AA64PFR2_EL1_GCIE_MASK); 2898cef63d6SBoyan Karatotev } 29030655136SGovindraj Raja 291714a1a93SManish Pandey static unsigned int read_feat_ebep_id_field(void) 292714a1a93SManish Pandey { 293714a1a93SManish Pandey return ISOLATE_FIELD(read_id_aa64dfr1_el1(), ID_AA64DFR1_EBEP_SHIFT, 294714a1a93SManish Pandey ID_AA64DFR1_EBEP_MASK); 295714a1a93SManish Pandey } 296714a1a93SManish Pandey 297a57e18e4SArvind Ram Prakash static unsigned int read_feat_fpmr_id_field(void) 298a57e18e4SArvind Ram Prakash { 299a57e18e4SArvind Ram Prakash return ISOLATE_FIELD(read_id_aa64pfr2_el1(), ID_AA64PFR2_EL1_FPMR_SHIFT, 300a57e18e4SArvind Ram Prakash ID_AA64PFR2_EL1_FPMR_MASK); 301a57e18e4SArvind Ram Prakash } 302a57e18e4SArvind Ram Prakash 3036b8df7b9SArvind Ram Prakash static unsigned int read_feat_mops_id_field(void) 3046b8df7b9SArvind Ram Prakash { 3056b8df7b9SArvind Ram Prakash return ISOLATE_FIELD(read_id_aa64isar2_el1(), ID_AA64ISAR2_EL1_MOPS_SHIFT, 3066b8df7b9SArvind Ram Prakash ID_AA64ISAR2_EL1_MOPS_MASK); 3076b8df7b9SArvind Ram Prakash } 3086b8df7b9SArvind Ram Prakash 3094274b526SArvind Ram Prakash static unsigned int read_feat_fgwte3_id_field(void) 3104274b526SArvind Ram Prakash { 3114274b526SArvind Ram Prakash return ISOLATE_FIELD(read_id_aa64mmfr4_el1(), ID_AA64MMFR4_EL1_FGWTE3_SHIFT, 3124274b526SArvind Ram Prakash ID_AA64MMFR4_EL1_FGWTE3_MASK); 3134274b526SArvind Ram Prakash } 3144274b526SArvind Ram Prakash 315a1032bebSJohn Powell static unsigned int read_feat_cpa_id_field(void) 316a1032bebSJohn Powell { 317a1032bebSJohn Powell return ISOLATE_FIELD(read_id_aa64isar3_el1(), 318a1032bebSJohn Powell ID_AA64ISAR3_EL1_CPA_SHIFT, 319a1032bebSJohn Powell ID_AA64ISAR3_EL1_CPA_MASK); 320a1032bebSJohn Powell } 321a1032bebSJohn Powell 322d6affea1SGovindraj Raja static unsigned int read_feat_clrbhb_id_field(void) 323d6affea1SGovindraj Raja { 324d6affea1SGovindraj Raja return ISOLATE_FIELD(read_id_aa64isar2_el1(), ID_AA64ISAR2_CLRBHB_SHIFT, 325d6affea1SGovindraj Raja ID_AA64ISAR2_CLRBHB_MASK); 326d6affea1SGovindraj Raja } 327d6affea1SGovindraj Raja 3285e827bf0STimothy Hayes static unsigned int read_feat_rme_gdi_id_field(void) 3295e827bf0STimothy Hayes { 3305e827bf0STimothy Hayes return ISOLATE_FIELD(read_id_aa64mmfr4_el1(), 3315e827bf0STimothy Hayes ID_AA64MMFR4_EL1_RME_GDI_SHIFT, 3325e827bf0STimothy Hayes ID_AA64MMFR4_EL1_RME_GDI_MASK); 3335e827bf0STimothy Hayes } 3345e827bf0STimothy Hayes 335*f396aec8SArvind Ram Prakash static unsigned int read_feat_idte3_id_field(void) 336*f396aec8SArvind Ram Prakash { 337*f396aec8SArvind Ram Prakash return ISOLATE_FIELD(read_id_aa64mmfr2_el1(), ID_AA64MMFR2_EL1_IDS_SHIFT, 338*f396aec8SArvind Ram Prakash ID_AA64MMFR2_EL1_IDS_MASK); 339*f396aec8SArvind Ram Prakash } 340*f396aec8SArvind Ram Prakash 3416a0da736SJayanth Dodderi Chidanand /*********************************************************************************** 3426a0da736SJayanth Dodderi Chidanand * TF-A supports many Arm architectural features starting from arch version 3436a0da736SJayanth Dodderi Chidanand * (8.0 till 8.7+). These features are mostly enabled through build flags. This 3446a0da736SJayanth Dodderi Chidanand * mechanism helps in validating these build flags in the early boot phase 3456a0da736SJayanth Dodderi Chidanand * either in BL1 or BL31 depending on the platform and assists in identifying 3466a0da736SJayanth Dodderi Chidanand * and notifying the features which are enabled but not supported by the PE. 3476a0da736SJayanth Dodderi Chidanand * 3486a0da736SJayanth Dodderi Chidanand * It reads all the enabled features ID-registers and ensures the features 3496a0da736SJayanth Dodderi Chidanand * are supported by the PE. 3506a0da736SJayanth Dodderi Chidanand * In case if they aren't it stops booting at an early phase and logs the error 3516a0da736SJayanth Dodderi Chidanand * messages, notifying the platforms about the features that are not supported. 3526a0da736SJayanth Dodderi Chidanand * 3536a0da736SJayanth Dodderi Chidanand * Further the procedure is implemented with a tri-state approach for each feature: 3546a0da736SJayanth Dodderi Chidanand * ENABLE_FEAT_xxx = 0 : The feature is disabled statically at compile time 3556a0da736SJayanth Dodderi Chidanand * ENABLE_FEAT_xxx = 1 : The feature is enabled and must be present in hardware. 3566a0da736SJayanth Dodderi Chidanand * There will be panic if feature is not present at cold boot. 3576a0da736SJayanth Dodderi Chidanand * ENABLE_FEAT_xxx = 2 : The feature is enabled but dynamically enabled at runtime 3586a0da736SJayanth Dodderi Chidanand * depending on hardware capability. 3596a0da736SJayanth Dodderi Chidanand * 36069c17f52SAndre Przywara * For better readability, state values are defined with macros, namely: 36169c17f52SAndre Przywara * { FEAT_STATE_DISABLED, FEAT_STATE_ALWAYS, FEAT_STATE_CHECK }, taking values 36269c17f52SAndre Przywara * { 0, 1, 2 }, respectively, as their naming. 3636a0da736SJayanth Dodderi Chidanand **********************************************************************************/ 364d335bbb1SBoyan Karatotev void detect_arch_features(unsigned int core_pos) 3656a0da736SJayanth Dodderi Chidanand { 366d335bbb1SBoyan Karatotev /* No need to keep checking after the first time for each core. */ 367d335bbb1SBoyan Karatotev if (detection_done[core_pos]) { 368d335bbb1SBoyan Karatotev return; 369d335bbb1SBoyan Karatotev } 370d335bbb1SBoyan Karatotev 371d335bbb1SBoyan Karatotev bool tainted = false; 372b45dd74eSAndre Przywara 3736a0da736SJayanth Dodderi Chidanand /* v8.0 features */ 374d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_SB, read_feat_sb_id_field(), 375d335bbb1SBoyan Karatotev "SB", 1, 1); 376d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_CSV2_2, read_feat_csv2_id_field(), 377aaaf2cc3SSona Mathew "CSV2_2", 2, 3); 378d6affea1SGovindraj Raja tainted |= check_feature(ENABLE_FEAT_CLRBHB, read_feat_clrbhb_id_field(), 379d6affea1SGovindraj Raja "CLRBHB", 1, 1); 380c73686a1SBoyan Karatotev /* 381c73686a1SBoyan Karatotev * Even though the PMUv3 is an OPTIONAL feature, it is always 382c73686a1SBoyan Karatotev * implemented and Arm prescribes so. So assume it will be there and do 383c73686a1SBoyan Karatotev * away with a flag for it. This is used to check minor PMUv3px 384c73686a1SBoyan Karatotev * revisions so that we catch them as they come along 385c73686a1SBoyan Karatotev */ 386d335bbb1SBoyan Karatotev tainted |= check_feature(FEAT_STATE_ALWAYS, read_feat_pmuv3_id_field(), 387ba9e6a34SAndre Przywara "PMUv3", 1, ID_AA64DFR0_PMUVER_PMUV3P9); 3886a0da736SJayanth Dodderi Chidanand 3896a0da736SJayanth Dodderi Chidanand /* v8.1 features */ 390d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_PAN, read_feat_pan_id_field(), 391d335bbb1SBoyan Karatotev "PAN", 1, 3); 392d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_VHE, read_feat_vhe_id_field(), 393d335bbb1SBoyan Karatotev "VHE", 1, 1); 3946a0da736SJayanth Dodderi Chidanand 3956a0da736SJayanth Dodderi Chidanand /* v8.2 features */ 396d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_SVE_FOR_NS, read_feat_sve_id_field(), 397aaaf2cc3SSona Mathew "SVE", 1, 1); 398d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_RAS, read_feat_ras_id_field(), 399d335bbb1SBoyan Karatotev "RAS", 1, 2); 4006a0da736SJayanth Dodderi Chidanand 4016a0da736SJayanth Dodderi Chidanand /* v8.3 features */ 402e293fcadSBoyan Karatotev /* the PAuth fields are very complicated, no min/max is checked */ 403e293fcadSBoyan Karatotev tainted |= check_feature(ENABLE_PAUTH, is_feat_pauth_present(), 404e293fcadSBoyan Karatotev "PAUTH", 1, 1); 4056a0da736SJayanth Dodderi Chidanand 4066a0da736SJayanth Dodderi Chidanand /* v8.4 features */ 407d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_DIT, read_feat_dit_id_field(), 408d335bbb1SBoyan Karatotev "DIT", 1, 1); 409d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_AMU, read_feat_amu_id_field(), 410a4cccb4fSAndre Przywara "AMUv1", 1, 2); 411d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_MOPS, read_feat_mops_id_field(), 4126b8df7b9SArvind Ram Prakash "MOPS", 1, 1); 413d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_MPAM, read_feat_mpam_version(), 4141f8be7fcSAndre Przywara "MPAM", 1, 17); 415d335bbb1SBoyan Karatotev tainted |= check_feature(CTX_INCLUDE_NEVE_REGS, read_feat_nv_id_field(), 416aaaf2cc3SSona Mathew "NV2", 2, 2); 417d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_SEL2, read_feat_sel2_id_field(), 418623f6140SAndre Przywara "SEL2", 1, 1); 419d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_TRF_FOR_NS, read_feat_trf_id_field(), 420fc8d2d39SAndre Przywara "TRF", 1, 1); 4216a0da736SJayanth Dodderi Chidanand 4226a0da736SJayanth Dodderi Chidanand /* v8.5 features */ 423d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_MTE2, get_armv8_5_mte_support(), 424d335bbb1SBoyan Karatotev "MTE2", MTE_IMPLEMENTED_ELX, MTE_IMPLEMENTED_ASY); 425d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_RNG, read_feat_rng_id_field(), 426d335bbb1SBoyan Karatotev "RNG", 1, 1); 427d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_BTI, read_feat_bti_id_field(), 428d335bbb1SBoyan Karatotev "BTI", 1, 1); 429d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_RNG_TRAP, read_feat_rng_trap_id_field(), 430011829b3SSona Mathew "RNG_TRAP", 1, 1); 4316a0da736SJayanth Dodderi Chidanand 4326a0da736SJayanth Dodderi Chidanand /* v8.6 features */ 433d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_AMUv1p1, read_feat_amu_id_field(), 434b57e16a4SAndre Przywara "AMUv1p1", 2, 2); 435d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_FGT, read_feat_fgt_id_field(), 436d335bbb1SBoyan Karatotev "FGT", 1, 2); 437d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_FGT2, read_feat_fgt_id_field(), 438d335bbb1SBoyan Karatotev "FGT2", 2, 2); 439d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_ECV, read_feat_ecv_id_field(), 440d335bbb1SBoyan Karatotev "ECV", 1, 2); 441d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_TWED, read_feat_twed_id_field(), 442aaaf2cc3SSona Mathew "TWED", 1, 1); 4436a0da736SJayanth Dodderi Chidanand 44483a4dae1SBoyan Karatotev /* 44583a4dae1SBoyan Karatotev * even though this is a "DISABLE" it does confusingly perform feature 44683a4dae1SBoyan Karatotev * enablement duties like all other flags here. Check it against the HW 44783a4dae1SBoyan Karatotev * feature when we intend to diverge from the default behaviour 44883a4dae1SBoyan Karatotev */ 449d335bbb1SBoyan Karatotev tainted |= check_feature(DISABLE_MTPMU, read_feat_mtpmu_id_field(), 450d335bbb1SBoyan Karatotev "MTPMU", 1, 1); 45183a4dae1SBoyan Karatotev 4526a0da736SJayanth Dodderi Chidanand /* v8.7 features */ 453d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_HCX, read_feat_hcx_id_field(), 454d335bbb1SBoyan Karatotev "HCX", 1, 1); 455d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_LS64_ACCDATA, read_feat_ls64_id_field(), 456d335bbb1SBoyan Karatotev "LS64", 1, 3); 4576a0da736SJayanth Dodderi Chidanand 458d3331603SMark Brown /* v8.9 features */ 459d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_TCR2, read_feat_tcr2_id_field(), 460d3331603SMark Brown "TCR2", 1, 1); 461d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_S2PIE, read_feat_s2pie_id_field(), 462062b6c6bSMark Brown "S2PIE", 1, 1); 463d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_S1PIE, read_feat_s1pie_id_field(), 464062b6c6bSMark Brown "S1PIE", 1, 1); 465d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_S2POE, read_feat_s2poe_id_field(), 466062b6c6bSMark Brown "S2POE", 1, 1); 467d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_S1POE, read_feat_s1poe_id_field(), 468062b6c6bSMark Brown "S1POE", 1, 1); 469d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_CSV2_3, read_feat_csv2_id_field(), 47030019d86SSona Mathew "CSV2_3", 3, 3); 471d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_DEBUGV8P9, read_feat_debugv8p9_id_field(), 47283271d5aSArvind Ram Prakash "DEBUGV8P9", 11, 11); 473d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_THE, read_feat_the_id_field(), 4746d0433f0SJayanth Dodderi Chidanand "THE", 1, 1); 475d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_SCTLR2, read_feat_sctlr2_id_field(), 4764ec4e545SJayanth Dodderi Chidanand "SCTLR2", 1, 1); 477cc2523bbSAndre Przywara tainted |= check_feature(ENABLE_FEAT_AIE, read_feat_aie_id_field(), 478cc2523bbSAndre Przywara "AIE", 1, 1); 479b3bcfd12SAndre Przywara tainted |= check_feature(ENABLE_FEAT_PFAR, read_feat_pfar_id_field(), 480b3bcfd12SAndre Przywara "PFAR", 1, 1); 481d3331603SMark Brown 4821298f2f1SJayanth Dodderi Chidanand /* v9.0 features */ 483d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_BRBE_FOR_NS, read_feat_brbe_id_field(), 484aaaf2cc3SSona Mathew "BRBE", 1, 2); 485d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_TRBE_FOR_NS, read_feat_trbe_id_field(), 486f5360cfaSAndre Przywara "TRBE", 1, 1); 4871298f2f1SJayanth Dodderi Chidanand 4886a0da736SJayanth Dodderi Chidanand /* v9.2 features */ 489d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_SME_FOR_NS, read_feat_sme_id_field(), 490aaaf2cc3SSona Mathew "SME", 1, 2); 491d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_SME2_FOR_NS, read_feat_sme_id_field(), 492aaaf2cc3SSona Mathew "SME2", 2, 2); 493d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_FPMR, read_feat_fpmr_id_field(), 494a57e18e4SArvind Ram Prakash "FPMR", 1, 1); 495688ab57bSMark Brown 49630655136SGovindraj Raja /* v9.3 features */ 497d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_D128, read_feat_d128_id_field(), 49830655136SGovindraj Raja "D128", 1, 1); 499d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_GCIE, read_feat_gcie_id_field(), 5008cef63d6SBoyan Karatotev "GCIE", 1, 1); 501c42aefd3SArvind Ram Prakash tainted |= check_feature(ENABLE_FEAT_MPAM_PE_BW_CTRL, 502c42aefd3SArvind Ram Prakash is_feat_mpam_pe_bw_ctrl_present(), 503c42aefd3SArvind Ram Prakash "MPAM_PE_BW_CTRL", 1, 1); 504714a1a93SManish Pandey tainted |= check_feature(ENABLE_FEAT_EBEP, read_feat_ebep_id_field(), 505714a1a93SManish Pandey "EBEP", 1, 1); 50630655136SGovindraj Raja 507688ab57bSMark Brown /* v9.4 features */ 508d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_GCS, read_feat_gcs_id_field(), 509d335bbb1SBoyan Karatotev "GCS", 1, 1); 510d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_RME, read_feat_rme_id_field(), 51109a4bcb8SGirish Pathak "RME", 1, 2); 512d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_PAUTH_LR, is_feat_pauth_lr_present(), 513d335bbb1SBoyan Karatotev "PAUTH_LR", 1, 1); 514d335bbb1SBoyan Karatotev tainted |= check_feature(ENABLE_FEAT_FGWTE3, read_feat_fgwte3_id_field(), 5154274b526SArvind Ram Prakash "FGWTE3", 1, 1); 516a1032bebSJohn Powell tainted |= check_feature(ENABLE_FEAT_CPA2, read_feat_cpa_id_field(), 517a1032bebSJohn Powell "CPA2", 2, 2); 5185e827bf0STimothy Hayes tainted |= check_feature(ENABLE_FEAT_RME_GDI, read_feat_rme_gdi_id_field(), 5195e827bf0STimothy Hayes "RME_GDI", 1, 1); 520*f396aec8SArvind Ram Prakash tainted |= check_feature(ENABLE_FEAT_IDTE3, read_feat_idte3_id_field(), 521*f396aec8SArvind Ram Prakash "IDTE3", 2, 2); 522b45dd74eSAndre Przywara 523b45dd74eSAndre Przywara if (tainted) { 524b45dd74eSAndre Przywara panic(); 525b45dd74eSAndre Przywara } 526d335bbb1SBoyan Karatotev 527d335bbb1SBoyan Karatotev detection_done[core_pos] = true; 5286a0da736SJayanth Dodderi Chidanand } 529