|
@@ -1,31 +1,45 @@
|
|
|
-# @file
|
|
|
-#
|
|
|
-# Copyright (c) 2012-2013, ARM Limited. All rights reserved.
|
|
|
-# Copyright 2017, 2020 NXP
|
|
|
-#
|
|
|
-# SPDX-License-Identifier: BSD-2-Clause-Patent
|
|
|
-#
|
|
|
+//
|
|
|
+// Copyright (c) 2012-2013, ARM Limited. All rights reserved.
|
|
|
+//
|
|
|
+// SPDX-License-Identifier: BSD-2-Clause-Patent
|
|
|
+//
|
|
|
+//
|
|
|
|
|
|
#include <AsmMacroIoLibV8.h>
|
|
|
-#include <AutoGen.h>
|
|
|
+#include <Library/ArmLib.h>
|
|
|
|
|
|
-.text
|
|
|
-.align 2
|
|
|
-
|
|
|
-GCC_ASM_IMPORT(ArmReadMpidr)
|
|
|
-
|
|
|
-ASM_FUNC(ArmPlatformIsPrimaryCore)
|
|
|
- tst x0, #3
|
|
|
- cset x0, eq
|
|
|
+ASM_FUNC(ArmPlatformPeiBootAction)
|
|
|
ret
|
|
|
|
|
|
-ASM_FUNC(ArmPlatformPeiBootAction)
|
|
|
-EL1_OR_EL2(x0)
|
|
|
-1:
|
|
|
-2:
|
|
|
+//UINTN
|
|
|
+//ArmPlatformGetCorePosition (
|
|
|
+// IN UINTN MpId
|
|
|
+// );
|
|
|
+// With this function: CorePos = (ClusterId * 4) + CoreId
|
|
|
+ASM_FUNC(ArmPlatformGetCorePosition)
|
|
|
+ and x1, x0, #ARM_CORE_MASK
|
|
|
+ and x0, x0, #ARM_CLUSTER_MASK
|
|
|
+ add x0, x1, x0, LSR #6
|
|
|
ret
|
|
|
|
|
|
+//UINTN
|
|
|
+//ArmPlatformGetPrimaryCoreMpId (
|
|
|
+// VOID
|
|
|
+// );
|
|
|
ASM_FUNC(ArmPlatformGetPrimaryCoreMpId)
|
|
|
- MOV32 (x0, FixedPcdGet32(PcdArmPrimaryCore))
|
|
|
- ldrh w0, [x0]
|
|
|
+ MOV32 (w0, FixedPcdGet32 (PcdArmPrimaryCore))
|
|
|
+ ret
|
|
|
+
|
|
|
+//UINTN
|
|
|
+//ArmPlatformIsPrimaryCore (
|
|
|
+// IN UINTN MpId
|
|
|
+// );
|
|
|
+ASM_FUNC(ArmPlatformIsPrimaryCore)
|
|
|
+ MOV32 (w1, FixedPcdGet32 (PcdArmPrimaryCoreMask))
|
|
|
+ and x0, x0, x1
|
|
|
+ MOV32 (w1, FixedPcdGet32 (PcdArmPrimaryCore))
|
|
|
+ cmp w0, w1
|
|
|
+ mov x0, #1
|
|
|
+ mov x1, #0
|
|
|
+ csel x0, x0, x1, eq
|
|
|
ret
|