1#
2#  Copyright (c) 2011-2013, ARM Limited. All rights reserved.
3#  Copyright (c) 2016, Linaro Limited. All rights reserved.
4#
5#  This program and the accompanying materials
6#  are licensed and made available under the terms and conditions of the BSD License
7#  which accompanies this distribution.  The full text of the license may be found at
8#  http://opensource.org/licenses/bsd-license.php
9#
10#  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
11#  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
12#
13#
14
15#include <AsmMacroIoLibV8.h>
16#include <Library/ArmLib.h>
17
18// VOID
19// ArmPlatformPeiBootAction (
20//   VOID   *DeviceTreeBaseAddress,   // passed by loader in x0
21//   VOID   *ImageBase                // passed by FDF trampoline in x1
22//   );
23ASM_FUNC(ArmPlatformPeiBootAction)
24  mov   x29, x30            // preserve LR
25  mov   x28, x0             // preserve DTB pointer
26  mov   x27, x1             // preserve base of image pointer
27
28  //
29  // If we are booting from RAM using the Linux kernel boot protocol, x0 will
30  // point to the DTB image in memory. Otherwise, we are just coming out of
31  // reset, and x0 will be 0.
32  //
33  cbz   x0, .Lout
34
35  //
36  // The base of the runtime image has been preserved in x1. Check whether
37  // the expected magic number can be found in the header.
38  //
39  ldr   w8, .LArm64LinuxMagic
40  ldr   w9, [x1, #0x38]
41  cmp   w8, w9
42  bne   .Lout
43
44  //
45  //
46  // OK, so far so good. We have confirmed that we likely have a DTB and are
47  // booting via the arm64 Linux boot protocol. Update the base-of-image PCD
48  // to the actual relocated value, and add the shift of PcdFdBaseAddress to
49  // PcdFvBaseAddress as well
50  //
51  adr   x8, PcdGet64 (PcdFdBaseAddress)
52  adr   x9, PcdGet64 (PcdFvBaseAddress)
53  ldr   x6, [x8]
54  ldr   x7, [x9]
55  sub   x7, x7, x6
56  add   x7, x7, x1
57  str   x1, [x8]
58  str   x7, [x9]
59
60  //
61  // Discover the memory size and offset from the DTB, and record in the
62  // respective PCDs. This will also return false if a corrupt DTB is
63  // encountered. Since we are calling a C function, use the window at the
64  // beginning of the FD image as a temp stack.
65  //
66  adr   x1, PcdGet64 (PcdSystemMemoryBase)
67  adr   x2, PcdGet64 (PcdSystemMemorySize)
68  mov   sp, x7
69  bl    FindMemnode
70  cbz   x0, .Lout
71
72  //
73  // Copy the DTB to the slack space right after the 64 byte arm64/Linux style
74  // image header at the base of this image (defined in the FDF), and record the
75  // pointer in PcdDeviceTreeInitialBaseAddress.
76  //
77  adr   x8, PcdGet64 (PcdDeviceTreeInitialBaseAddress)
78  add   x27, x27, #0x40
79  str   x27, [x8]
80
81  mov   x0, x27
82  mov   x1, x28
83  bl    CopyFdt
84
85.Lout:
86  ret    x29
87
88.LArm64LinuxMagic:
89  .byte   0x41, 0x52, 0x4d, 0x64
90
91//UINTN
92//ArmPlatformGetPrimaryCoreMpId (
93//  VOID
94//  );
95ASM_FUNC(ArmPlatformGetPrimaryCoreMpId)
96  MOV32  (w0, FixedPcdGet32 (PcdArmPrimaryCore))
97  ret
98
99//UINTN
100//ArmPlatformIsPrimaryCore (
101//  IN UINTN MpId
102//  );
103ASM_FUNC(ArmPlatformIsPrimaryCore)
104  mov   x0, #1
105  ret
106
107//UINTN
108//ArmPlatformGetCorePosition (
109//  IN UINTN MpId
110//  );
111// With this function: CorePos = (ClusterId * 4) + CoreId
112ASM_FUNC(ArmPlatformGetCorePosition)
113  and   x1, x0, #ARM_CORE_MASK
114  and   x0, x0, #ARM_CLUSTER_MASK
115  add   x0, x1, x0, LSR #6
116  ret
117
118//EFI_PHYSICAL_ADDRESS
119//GetPhysAddrTop (
120//  VOID
121//  );
122ASM_FUNC(ArmGetPhysAddrTop)
123  mrs   x0, id_aa64mmfr0_el1
124  adr   x1, .LPARanges
125  and   x0, x0, #7
126  ldrb  w1, [x1, x0]
127  mov   x0, #1
128  lsl   x0, x0, x1
129  ret
130
131//
132// Bits 0..2 of the AA64MFR0_EL1 system register encode the size of the
133// physical address space support on this CPU:
134// 0 == 32 bits, 1 == 36 bits, etc etc
135// 6 and 7 are reserved
136//
137.LPARanges:
138  .byte 32, 36, 40, 42, 44, 48, -1, -1
139
140ASM_FUNCTION_REMOVE_IF_UNREFERENCED
141