mirror of https://github.com/acidanthera/audk.git
98 lines
2.4 KiB
NASM
98 lines
2.4 KiB
NASM
//
|
|
// 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>
|
|
|
|
#include <ArmPlatform.h>
|
|
|
|
INCLUDE AsmMacroIoLib.inc
|
|
|
|
EXPORT ArmPlatformPeiBootAction
|
|
EXPORT ArmPlatformGetCorePosition
|
|
EXPORT ArmPlatformIsPrimaryCore
|
|
EXPORT ArmPlatformGetPrimaryCoreMpId
|
|
|
|
PRESERVE8
|
|
AREA CTA15A7Helper, CODE, READONLY
|
|
|
|
ArmPlatformPeiBootAction FUNCTION
|
|
bx lr
|
|
ENDFUNC
|
|
|
|
//UINTN
|
|
//ArmPlatformGetCorePosition (
|
|
// IN UINTN MpId
|
|
// );
|
|
ArmPlatformGetCorePosition FUNCTION
|
|
and r1, r0, #ARM_CORE_MASK
|
|
and r0, r0, #ARM_CLUSTER_MASK
|
|
add r0, r1, r0, LSR #7
|
|
bx lr
|
|
ENDFUNC
|
|
|
|
//UINTN
|
|
//ArmPlatformIsPrimaryCore (
|
|
// IN UINTN MpId
|
|
// );
|
|
ArmPlatformIsPrimaryCore FUNCTION
|
|
// Extract cpu_id and cluster_id from ARM_SCC_CFGREG48
|
|
// with cpu_id[0:3] and cluster_id[4:7]
|
|
LoadConstantToReg (ARM_CTA15A7_SCC_CFGREG48, r1)
|
|
ldr r1, [r1]
|
|
lsr r1, #24
|
|
|
|
// Shift the SCC value to get the cluster ID at the offset #8
|
|
lsl r2, r1, #4
|
|
and r2, r2, #0xF00
|
|
|
|
// Keep only the cpu ID from the original SCC
|
|
and r1, r1, #0x0F
|
|
// Add the Cluster ID to the Cpu ID
|
|
orr r1, r1, r2
|
|
|
|
// Keep the Cluster ID and Core ID from the MPID
|
|
LoadConstantToReg (ARM_CLUSTER_MASK :OR: ARM_CORE_MASK, r2)
|
|
and r0, r0, r2
|
|
|
|
// Compare mpid and boot cpu from ARM_SCC_CFGREG48
|
|
cmp r0, r1
|
|
moveq r0, #1
|
|
movne r0, #0
|
|
bx lr
|
|
ENDFUNC
|
|
|
|
//UINTN
|
|
//ArmPlatformGetPrimaryCoreMpId (
|
|
// VOID
|
|
// );
|
|
ArmPlatformGetPrimaryCoreMpId FUNCTION
|
|
// Extract cpu_id and cluster_id from ARM_SCC_CFGREG48
|
|
// with cpu_id[0:3] and cluster_id[4:7]
|
|
LoadConstantToReg (ARM_CTA15A7_SCC_CFGREG48, r0)
|
|
ldr r0, [r0]
|
|
lsr r0, #24
|
|
|
|
// Shift the SCC value to get the cluster ID at the offset #8
|
|
lsl r1, r0, #4
|
|
and r1, r1, #0xF00
|
|
|
|
// Keep only the cpu ID from the original SCC
|
|
and r0, r0, #0x0F
|
|
// Add the Cluster ID to the Cpu ID
|
|
orr r0, r0, r1
|
|
bx lr
|
|
ENDFUNC
|
|
|
|
END
|