| // | |
| // Copyright (c) 2012-2013, 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. | |
| // | |
| // | |
| #include <AsmMacroIoLib.h> | |
| #include <Library/ArmLib.h> | |
| .text | |
| .align 2 | |
| GCC_ASM_EXPORT(ArmPlatformPeiBootAction) | |
| GCC_ASM_EXPORT(ArmPlatformGetCorePosition) | |
| GCC_ASM_EXPORT(ArmPlatformGetPrimaryCoreMpId) | |
| GCC_ASM_EXPORT(ArmPlatformIsPrimaryCore) | |
| GCC_ASM_IMPORT(_gPcd_FixedAtBuild_PcdArmPrimaryCore) | |
| GCC_ASM_IMPORT(_gPcd_FixedAtBuild_PcdArmPrimaryCoreMask) | |
| ASM_PFX(ArmPlatformPeiBootAction): | |
| bx lr | |
| //UINTN | |
| //ArmPlatformGetCorePosition ( | |
| // IN UINTN MpId | |
| // ); | |
| ASM_PFX(ArmPlatformGetCorePosition): | |
| and r1, r0, #ARM_CORE_MASK | |
| and r0, r0, #ARM_CLUSTER_MASK | |
| add r0, r1, r0, LSR #7 | |
| bx lr | |
| //UINTN | |
| //ArmPlatformGetPrimaryCoreMpId ( | |
| // VOID | |
| // ); | |
| ASM_PFX(ArmPlatformGetPrimaryCoreMpId): | |
| LoadConstantToReg (_gPcd_FixedAtBuild_PcdArmPrimaryCore, r0) | |
| ldr r0, [r0] | |
| bx lr | |
| //UINTN | |
| //ArmPlatformIsPrimaryCore ( | |
| // IN UINTN MpId | |
| // ); | |
| ASM_PFX(ArmPlatformIsPrimaryCore): | |
| LoadConstantToReg (_gPcd_FixedAtBuild_PcdArmPrimaryCoreMask, r1) | |
| ldr r1, [r1] | |
| and r0, r0, r1 | |
| LoadConstantToReg (_gPcd_FixedAtBuild_PcdArmPrimaryCore, r1) | |
| ldr r1, [r1] | |
| cmp r0, r1 | |
| moveq r0, #1 | |
| movne r0, #0 | |
| bx lr |