ARM Packages: Replace tabs by spaces for indentation

[mirror_edk2.git] / ArmPlatformPkg / Library / ArmPlatformStackLib / Arm / ArmPlatformStackLib.asm

//\r
//  Copyright (c) 2012-2013, ARM Limited. All rights reserved.\r
//\r
//  This program and the accompanying materials\r
//  are licensed and made available under the terms and conditions of the BSD License\r
//  which accompanies this distribution.  The full text of the license may be found at\r
//  http://opensource.org/licenses/bsd-license.php\r
//\r
//  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,\r
//  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.\r
//\r
//\r
\r
#include <AsmMacroIoLib.h>\r
#include <Base.h>\r
#include <AutoGen.h>\r
\r
  INCLUDE AsmMacroIoLib.inc\r
\r
  EXPORT  ArmPlatformStackSet\r
  EXPORT  ArmPlatformStackSetPrimary\r
  EXPORT  ArmPlatformStackSetSecondary\r
\r
  IMPORT  ArmPlatformIsPrimaryCore\r
  IMPORT  ArmPlatformGetCorePosition\r
  IMPORT  ArmPlatformGetPrimaryCoreMpId\r
\r
  IMPORT  _gPcd_FixedAtBuild_PcdCoreCount\r
\r
  PRESERVE8\r
  AREA    ArmPlatformStackLib, CODE, READONLY\r
\r
//VOID\r
//ArmPlatformStackSet (\r
//  IN UINTN StackBase,\r
//  IN UINTN MpId,\r
//  IN UINTN PrimaryStackSize,\r
//  IN UINTN SecondaryStackSize\r
//  );\r
ArmPlatformStackSet FUNCTION\r
  // Save parameters\r
  mov   r6, r3\r
  mov   r5, r2\r
  mov   r4, r1\r
  mov   r3, r0\r
\r
  // Save the Link register\r
  mov   r7, lr\r
\r
  // Identify Stack\r
  mov   r0, r1\r
  bl    ArmPlatformIsPrimaryCore\r
  cmp   r0, #1\r
\r
  // Restore parameters\r
  mov   r0, r3\r
  mov   r1, r4\r
  mov   r2, r5\r
  mov   r3, r6\r
\r
  // Restore the Link register\r
  mov   lr, r7\r
\r
  beq   ArmPlatformStackSetPrimary\r
  bne   ArmPlatformStackSetSecondary\r
  ENDFUNC\r
\r
//VOID\r
//ArmPlatformStackSetPrimary (\r
//  IN UINTN StackBase,\r
//  IN UINTN MpId,\r
//  IN UINTN PrimaryStackSize,\r
//  IN UINTN SecondaryStackSize\r
//  );\r
ArmPlatformStackSetPrimary FUNCTION\r
  mov   r4, lr\r
\r
  // Add stack of primary stack to StackBase\r
  add   r0, r0, r2\r
\r
  // Compute SecondaryCoresCount * SecondaryCoreStackSize\r
  LoadConstantToReg (_gPcd_FixedAtBuild_PcdCoreCount, r1)\r
  ldr   r1, [r1]\r
  sub   r1, #1\r
  mul   r3, r3, r1\r
\r
  // Set Primary Stack ((StackBase + PrimaryStackSize) + (SecondaryCoresCount * SecondaryCoreStackSize))\r
  add   sp, r0, r3\r
\r
  bx    r4\r
  ENDFUNC\r
\r
//VOID\r
//ArmPlatformStackSetSecondary (\r
//  IN UINTN StackBase,\r
//  IN UINTN MpId,\r
//  IN UINTN PrimaryStackSize,\r
//  IN UINTN SecondaryStackSize\r
//  );\r
ArmPlatformStackSetSecondary FUNCTION\r
  mov   r4, lr\r
  mov   sp, r0\r
\r
  // Get Core Position\r
  mov   r0, r1\r
  bl ArmPlatformGetCorePosition\r
  mov   r5, r0\r
\r
  // Get Primary Core Position\r
  bl ArmPlatformGetPrimaryCoreMpId\r
  bl ArmPlatformGetCorePosition\r
\r
  // Get Secondary Core Position. We should get consecutive secondary stack number from 1...(CoreCount-1)\r
  cmp   r5, r0\r
  subhi r5, r5, #1\r
  add   r5, r5, #1\r
\r
  // Compute top of the secondary stack\r
  mul   r3, r3, r5\r
\r
  // Set stack\r
  add   sp, sp, r3\r
\r
  bx r4\r
  ENDFUNC\r
\r
  END\r