-// load _Reg with _Data if eq\r
-#define LoadConstantToRegIfEq(_Data, _Reg) \\r
- ldreq _Reg, [pc, #0] ; \\r
- b 1f ; \\r
- .long (_Data) ; \\r
-1:\r
-\r
-// Convert the (ClusterId,CoreId) into a Core Position\r
-// We assume there are 4 cores per cluster\r
-// Note: 0xFFFF is the magic value for ARM_CORE_MASK | ARM_CLUSTER_MASK\r
-#define GetCorePositionFromMpId(Pos, MpId, Tmp) \\r
- ldr Tmp, =0xFFFF \\r
- and MpId, Tmp \\r
- lsr Pos, MpId, #6 ; \\r
- and Tmp, MpId, #3 ; \\r
- add Pos, Pos, Tmp\r
-\r
-// Reserve a region at the top of the Primary Core stack\r
-// for Global variables for the XIP phase\r
-#define SetPrimaryStack(StackTop, GlobalSize, Tmp) \\r
- and Tmp, GlobalSize, #7 ; \\r
- rsbne Tmp, Tmp, #8 ; \\r
- add GlobalSize, GlobalSize, Tmp ; \\r
- sub sp, StackTop, GlobalSize ; \\r
- ; \\r
- mov Tmp, sp ; \\r
- mov GlobalSize, #0x0 ; \\r
-_SetPrimaryStackInitGlobals: ; \\r
- cmp Tmp, StackTop ; \\r
- beq _SetPrimaryStackEnd ; \\r
- str GlobalSize, [Tmp], #4 ; \\r
- b _SetPrimaryStackInitGlobals ; \\r
-_SetPrimaryStackEnd:\r
-\r
-// Initialize the Global Variable with '0'\r
-#define InitializePrimaryStack(GlobalSize, Tmp1) \\r
- and Tmp1, GlobalSize, #7 ; \\r
- rsbne Tmp1, Tmp1, #8 ; \\r
- add GlobalSize, GlobalSize, Tmp1 ; \\r
- ; \\r
- mov Tmp1, sp ; \\r
- sub sp, GlobalSize ; \\r
- mov GlobalSize, #0x0 ; \\r
-_InitializePrimaryStackLoop: ; \\r
- cmp Tmp1, sp ; \\r
- bls _InitializePrimaryStackEnd ; \\r
- str GlobalSize, [Tmp1], #-4 ; \\r
- b _InitializePrimaryStackLoop ; \\r
-_InitializePrimaryStackEnd:\r
-\r