ArmVirtPkg: clean up assembly source files

[mirror_edk2.git] / ArmVirtPkg / Library / ArmQemuRelocatablePlatformLib / AARCH64 / RelocatableVirtHelper.S

#\r
#  Copyright (c) 2011-2013, ARM Limited. All rights reserved.\r
#  Copyright (c) 2016, Linaro 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 <AsmMacroIoLibV8.h>\r
#include <Library/ArmLib.h>\r
\r
// VOID\r
// ArmPlatformPeiBootAction (\r
//   VOID   *DeviceTreeBaseAddress,   // passed by loader in x0\r
//   VOID   *ImageBase                // passed by FDF trampoline in x1\r
//   );\r
ASM_FUNC(ArmPlatformPeiBootAction)\r
  //\r
  // If we are booting from RAM using the Linux kernel boot protocol, x0 will\r
  // point to the DTB image in memory. Otherwise, use the default value defined\r
  // by the platform.\r
  //\r
  cbnz  x0, 0f\r
  ldr   x0, PcdGet64 (PcdDeviceTreeInitialBaseAddress)\r
\r
0:mov   x29, x30            // preserve LR\r
  mov   x28, x0             // preserve DTB pointer\r
  mov   x27, x1             // preserve base of image pointer\r
\r
  //\r
  // The base of the runtime image has been preserved in x1. Check whether\r
  // the expected magic number can be found in the header.\r
  //\r
  ldr   w8, .LArm64LinuxMagic\r
  ldr   w9, [x1, #0x38]\r
  cmp   w8, w9\r
  bne   .Lout\r
\r
  //\r
  //\r
  // OK, so far so good. We have confirmed that we likely have a DTB and are\r
  // booting via the arm64 Linux boot protocol. Update the base-of-image PCD\r
  // to the actual relocated value, and add the shift of PcdFdBaseAddress to\r
  // PcdFvBaseAddress as well\r
  //\r
  adr   x8, PcdGet64 (PcdFdBaseAddress)\r
  adr   x9, PcdGet64 (PcdFvBaseAddress)\r
  ldr   x6, [x8]\r
  ldr   x7, [x9]\r
  sub   x7, x7, x6\r
  add   x7, x7, x1\r
  str   x1, [x8]\r
  str   x7, [x9]\r
\r
  //\r
  // Discover the memory size and offset from the DTB, and record in the\r
  // respective PCDs. This will also return false if a corrupt DTB is\r
  // encountered. Since we are calling a C function, use the window at the\r
  // beginning of the FD image as a temp stack.\r
  //\r
  adr   x1, PcdGet64 (PcdSystemMemoryBase)\r
  adr   x2, PcdGet64 (PcdSystemMemorySize)\r
  mov   sp, x7\r
  bl    FindMemnode\r
  cbz   x0, .Lout\r
\r
  //\r
  // Copy the DTB to the slack space right after the 64 byte arm64/Linux style\r
  // image header at the base of this image (defined in the FDF), and record the\r
  // pointer in PcdDeviceTreeInitialBaseAddress.\r
  //\r
  adr   x8, PcdGet64 (PcdDeviceTreeInitialBaseAddress)\r
  add   x27, x27, #0x40\r
  str   x27, [x8]\r
\r
  mov   x0, x27\r
  mov   x1, x28\r
  bl    CopyFdt\r
\r
.Lout:\r
  ret    x29\r
\r
.LArm64LinuxMagic:\r
  .byte   0x41, 0x52, 0x4d, 0x64\r
\r
//UINTN\r
//ArmPlatformGetPrimaryCoreMpId (\r
//  VOID\r
//  );\r
ASM_FUNC(ArmPlatformGetPrimaryCoreMpId)\r
  MOV32  (w0, FixedPcdGet32 (PcdArmPrimaryCore))\r
  ret\r
\r
//UINTN\r
//ArmPlatformIsPrimaryCore (\r
//  IN UINTN MpId\r
//  );\r
ASM_FUNC(ArmPlatformIsPrimaryCore)\r
  mov   x0, #1\r
  ret\r
\r
//UINTN\r
//ArmPlatformGetCorePosition (\r
//  IN UINTN MpId\r
//  );\r
// With this function: CorePos = (ClusterId * 4) + CoreId\r
ASM_FUNC(ArmPlatformGetCorePosition)\r
  and   x1, x0, #ARM_CORE_MASK\r
  and   x0, x0, #ARM_CLUSTER_MASK\r
  add   x0, x1, x0, LSR #6\r
  ret\r
\r
//EFI_PHYSICAL_ADDRESS\r
//GetPhysAddrTop (\r
//  VOID\r
//  );\r
ASM_FUNC(ArmGetPhysAddrTop)\r
  mrs   x0, id_aa64mmfr0_el1\r
  adr   x1, .LPARanges\r
  and   x0, x0, #7\r
  ldrb  w1, [x1, x0]\r
  mov   x0, #1\r
  lsl   x0, x0, x1\r
  ret\r
\r
//\r
// Bits 0..2 of the AA64MFR0_EL1 system register encode the size of the\r
// physical address space support on this CPU:\r
// 0 == 32 bits, 1 == 36 bits, etc etc\r
// 6 and 7 are reserved\r
//\r
.LPARanges:\r
  .byte 32, 36, 40, 42, 44, 48, -1, -1\r
\r
ASM_FUNCTION_REMOVE_IF_UNREFERENCED\r