ArmPlatformPkg/ArmVExpressPkg/Library/ArmVExpressLibCTA9x4/CTA9x4Helper.asm

   1 //
   2 //  Copyright (c) 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 <AutoGen.h>
  18
  19   INCLUDE AsmMacroIoLib.inc
  20
  21   EXPORT  ArmPlatformIsPrimaryCore
  22   EXPORT  ArmPlatformGetPrimaryCoreMpId
  23   EXPORT  ArmPlatformGetCorePosition
  24
  25   IMPORT  _gPcd_FixedAtBuild_PcdArmPrimaryCore
  26   IMPORT  _gPcd_FixedAtBuild_PcdArmPrimaryCoreMask
  27
  28   AREA CTA9x4Helper, CODE, READONLY
  29
  30 //UINTN
  31 //ArmPlatformGetPrimaryCoreMpId (
  32 //  VOID
  33 //  );
  34 ArmPlatformGetPrimaryCoreMpId FUNCTION
  35   LoadConstantToReg (_gPcd_FixedAtBuild_PcdArmPrimaryCoreMask, r0)
  36   ldr     r0, [r0]
  37   bx      lr
  38   ENDFUNC
  39
  40 //UINTN
  41 //ArmPlatformIsPrimaryCore (
  42 //  IN UINTN MpId
  43 //  );
  44 ArmPlatformIsPrimaryCore FUNCTION
  45   LoadConstantToReg (_gPcd_FixedAtBuild_PcdArmPrimaryCoreMask, r1)
  46   ldr   r1, [r1]
  47   and   r0, r0, r1
  48   LoadConstantToReg (_gPcd_FixedAtBuild_PcdArmPrimaryCore, r1)
  49   ldr   r1, [r1]
  50   cmp   r0, r1
  51   moveq r0, #1
  52   movne r0, #0
  53   bx    lr
  54   ENDFUNC
  55
  56 //UINTN
  57 //ArmPlatformGetCorePosition (
  58 //  IN UINTN MpId
  59 //  );
  60 ArmPlatformGetCorePosition FUNCTION
  61   and   r0, r0, #ARM_CORE_MASK
  62   bx    lr
  63   ENDFUNC
  64
  65   END