diff --git a/ArmPkg/Drivers/ArmCpuLib/ArmCortexA15Lib/ArmCortexA15Lib.c b/ArmPkg/Drivers/ArmCpuLib/ArmCortexA15Lib/ArmCortexA15Lib.c index 9b64d662d9..95ab073e18 100644 --- a/ArmPkg/Drivers/ArmCpuLib/ArmCortexA15Lib/ArmCortexA15Lib.c +++ b/ArmPkg/Drivers/ArmCpuLib/ArmCortexA15Lib/ArmCortexA15Lib.c @@ -20,7 +20,7 @@ #include #include -#include +#include VOID ArmCpuSetup ( @@ -41,10 +41,11 @@ ArmCpuSetup ( // if security extensions are implemented. ArmArchTimerSetTimerFreq (PcdGet32 (PcdArmArchTimerFreqInHz)); - /*// If MPCore then Enable the SCU if (ArmIsMpCore()) { - ArmEnableScu (); - }*/ + // Turn on SMP coherency + ArmSetAuxCrBit (A15_FEATURE_SMP); + } + } @@ -53,8 +54,6 @@ ArmCpuSetupSmpNonSecure ( IN UINTN MpId ) { - //ArmSetAuxCrBit (A15_FEATURE_SMP); - /*// Make the SCU accessible in Non Secure world if (IS_PRIMARY_CORE(MpId)) { ScuBase = ArmGetScuBaseAddress(); diff --git a/ArmPkg/Drivers/ArmCpuLib/ArmCortexA9Lib/ArmCortexA9Lib.c b/ArmPkg/Drivers/ArmCpuLib/ArmCortexA9Lib/ArmCortexA9Lib.c index 324ddb5850..8d9530cee2 100644 --- a/ArmPkg/Drivers/ArmCpuLib/ArmCortexA9Lib/ArmCortexA9Lib.c +++ b/ArmPkg/Drivers/ArmCpuLib/ArmCortexA9Lib/ArmCortexA9Lib.c @@ -48,6 +48,9 @@ ArmCpuSetup ( // If MPCore then Enable the SCU if (ArmIsMpCore()) { + // Signals the Cortex-A9 processor is taking part in coherency + ArmSetAuxCrBit (A9_FEATURE_SMP); + ArmEnableScu (); } } @@ -60,8 +63,6 @@ ArmCpuSetupSmpNonSecure ( { INTN ScuBase; - ArmSetAuxCrBit (A9_FEATURE_SMP); - // Make the SCU accessible in Non Secure world if (IS_PRIMARY_CORE(MpId)) { ScuBase = ArmGetScuBaseAddress(); diff --git a/ArmPkg/Include/Chipset/ArmCortexA15.h b/ArmPkg/Include/Chipset/ArmCortexA15.h new file mode 100644 index 0000000000..5f7156789d --- /dev/null +++ b/ArmPkg/Include/Chipset/ArmCortexA15.h @@ -0,0 +1,25 @@ +/** @file + + Copyright (c) 2012, ARM Limited. All rights reserved. + + This program and the accompanying materials + are licensed and made available under the terms and conditions of the BSD License + which accompanies this distribution. The full text of the license may be found at + http://opensource.org/licenses/bsd-license.php + + THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, + WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. + +**/ + +#ifndef __ARM_CORTEX_A15_H__ +#define __ARM_CORTEX_A15_H__ + +#include + +// +// Cortex A15 feature bit definitions +// +#define A15_FEATURE_SMP (1<<6) + +#endif