.long (_Data) ; \\r
1:\r
\r
-// Convert the (ClusterId,CoreId) into a Core Position\r
-// We assume there are 4 cores per cluster\r
-#define GetCorePositionFromMpId(Pos, 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
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
#elif defined (__GNUC__)\r
\r
\r
#define LoadConstantToReg(Data, Reg) \\r
ldr Reg, =Data\r
- \r
-#define GetCorePositionFromMpId(Pos, MpId, Tmp) \\r
- lsr Pos, MpId, #6 ; \\r
- and Tmp, MpId, #3 ; \\r
- add Pos, Pos, Tmp\r
\r
#define SetPrimaryStack(StackTop, GlobalSize, Tmp) \\r
and Tmp, GlobalSize, #7 ; \\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
#else\r
\r
//\r
// conditional load testing eq flag\r
#define LoadConstantToRegIfEq(Data, Reg) LoadConstantToRegIfEqMacro Data, Reg\r
\r
-#define GetCorePositionFromMpId(Pos, MpId, Tmp) GetCorePositionFromMpId Pos, MpId, Tmp\r
-\r
#define SetPrimaryStack(StackTop,GlobalSize,Tmp) SetPrimaryStack StackTop, GlobalSize, Tmp\r
\r
+// Initialize the Global Variable with '0'\r
+#define InitializePrimaryStack(GlobalSize, Tmp1) InitializePrimaryStack GlobalSize, Tmp1\r
+\r
#endif\r
\r
#endif\r