1# 2# Copyright (c) 2011-2013, ARM Limited. All rights reserved. 3# 4# This program and the accompanying materials 5# are licensed and made available under the terms and conditions of the BSD License 6# which accompanies this distribution. The full text of the license may be found at 7# http://opensource.org/licenses/bsd-license.php 8# 9# THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS, 10# WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED. 11# 12# 13 14#include <AsmMacroIoLib.h> 15#include <Library/ArmLib.h> 16 17#include <Chipset/ArmCortexA9.h> 18 19ASM_FUNC(ArmPlatformPeiBootAction) 20 bx lr 21 22# IN None 23# OUT r0 = SCU Base Address 24ASM_FUNC(ArmGetScuBaseAddress) 25 # Read Configuration Base Address Register. ArmCBar cannot be called to get 26 # the Configuration BAR as a stack is not necessary setup. The SCU is at the 27 # offset 0x0000 from the Private Memory Region. 28 mrc p15, 4, r0, c15, c0, 0 29 bx lr 30 31//UINTN 32//ArmPlatformGetPrimaryCoreMpId ( 33// VOID 34// ); 35ASM_FUNC(ArmPlatformGetPrimaryCoreMpId) 36 MOV32 (r0, FixedPcdGet32 (PcdArmPrimaryCore)) 37 bx lr 38 39# IN None 40# OUT r0 = number of cores present in the system 41ASM_FUNC(ArmGetCpuCountPerCluster) 42 stmfd SP!, {r1-r2} 43 44 # Read CP15 MIDR 45 mrc p15, 0, r1, c0, c0, 0 46 47 # Check if the CPU is A15 48 mov r1, r1, LSR #4 49 MOV32 (r0, ARM_CPU_TYPE_MASK) 50 and r1, r1, r0 51 52 MOV32 (r0, ARM_CPU_TYPE_A15) 53 cmp r1, r0 54 beq _Read_cp15_reg 55 56_CPU_is_not_A15: 57 mov r2, lr @ Save link register 58 bl ArmGetScuBaseAddress @ Read SCU Base Address 59 mov lr, r2 @ Restore link register val 60 ldr r0, [r0, #A9_SCU_CONFIG_OFFSET] @ Read SCU Config reg to get CPU count 61 b _Return 62 63_Read_cp15_reg: 64 mrc p15, 1, r0, c9, c0, 2 @ Read C9 register of CP15 to get CPU count 65 lsr r0, #24 66 67_Return: 68 and r0, r0, #3 69 # Add '1' to the number of CPU on the Cluster 70 add r0, r0, #1 71 ldmfd SP!, {r1-r2} 72 bx lr 73 74//UINTN 75//ArmPlatformIsPrimaryCore ( 76// IN UINTN MpId 77// ); 78ASM_FUNC(ArmPlatformIsPrimaryCore) 79 MOV32 (r1, FixedPcdGet32 (PcdArmPrimaryCoreMask)) 80 and r0, r0, r1 81 MOV32 (r1, FixedPcdGet32 (PcdArmPrimaryCore)) 82 cmp r0, r1 83 moveq r0, #1 84 movne r0, #0 85 bx lr 86 87//UINTN 88//ArmPlatformGetCorePosition ( 89// IN UINTN MpId 90// ); 91ASM_FUNC(ArmPlatformGetCorePosition) 92 and r1, r0, #ARM_CORE_MASK 93 and r0, r0, #ARM_CLUSTER_MASK 94 add r0, r1, r0, LSR #7 95 bx lr 96 97ASM_FUNCTION_REMOVE_IF_UNREFERENCED 98