+++ /dev/null
-//%HEADER%\r
- MACRO\r
- MmioWrite32Macro $Address, $Data\r
- ldr r1, = ($Address) \r
- ldr r0, = ($Data) \r
- str r0, [r1] \r
- MEND
-
- MACRO\r
- MmioOr32Macro $Address, $OrData\r
- ldr r1, =($Address) \r
- ldr r2, =($OrData) \r
- ldr r0, [r1] \r
- orr r0, r0, r2 \r
- str r0, [r1]\r
- MEND
-
- MACRO\r
- MmioAnd32Macro $Address, $AndData\r
- ldr r1, =($Address) \r
- ldr r2, =($AndData) \r
- ldr r0, [r1] \r
- and r0, r0, r2 \r
- str r0, [r1]\r
- MEND
-
- MACRO\r
- MmioAndThenOr32Macro $Address, $AndData, $OrData\r
- ldr r1, =($Address) \r
- ldr r0, [r1] \r
- ldr r2, =($AndData) \r
- and r0, r0, r2 \r
- ldr r2, =($OrData) \r
- orr r0, r0, r2 \r
- str r0, [r1] \r
- MEND
-
- MACRO\r
- MmioWriteFromReg32Macro $Address, $Reg\r
- ldr r1, =($Address) \r
- str $Reg, [r1] \r
- MEND
-
- MACRO\r
- MmioRead32Macro $Address \r
- ldr r1, =($Address) \r
- ldr r0, [r1] \r
- MEND
-
- MACRO\r
- MmioReadToReg32Macro $Address, $Reg\r
- ldr r1, =($Address) \r
- ldr $Reg, [r1] \r
- MEND
-
- MACRO\r
- LoadConstantMacro $Data\r
- ldr r0, =($Data)\r
- MEND
-
- MACRO\r
- LoadConstantToRegMacro $Data, $Reg\r
- ldr $Reg, =($Data)\r
- MEND\r
- \r
- END\r
-
\ No newline at end of file
// Set CPU vectors to start of DRAM\r
mov r0, #0x80000000\r
mcr p15, 0, r0, c12, c0, 0\r
+ isb // Sync changes to control registers\r
+\r
/* before we call C code, lets setup the stack pointer in internal RAM*/\r
stack_pointer_setup:\r
\r
mcr p15, 0, r0, c1, c0, 0\r
\r
// Set CPU vectors to start of DRAM\r
- mov r0, #0x80000000\r
+ LoadConstantToReg (FixedPcdGet32(PcdMemoryBase) ,r0) /* memory size arg0 */\r
mcr p15, 0, r0, c12, c0, 0\r
+ isb // Sync changes to control registers\r
+\r
+ // Fill vector table with branchs to current pc (jmp $)\r
+ ldr r1, ShouldNeverGetHere\r
+ movs r2, #0\r
+FillVectors\r
+ str r1, [r0, r2]\r
+ adds r2, r2, #4\r
+ cmp r2, #32\r
+ bne FillVectors\r
+ \r
/* before we call C code, lets setup the stack pointer in internal RAM*/\r
stack_pointer_setup\r
\r
add r4, r2, r3\r
\r
//Enter SVC mode and set up SVC stack pointer\r
- mov r0,#0x13|0x80|0x40\r
- msr CPSR_c,r0\r
+ mov r5,#0x13|0x80|0x40\r
+ msr CPSR_c,r5\r
mov r13,r4\r
\r
// Call C entry point\r
LoadConstantToReg (FixedPcdGet32(PcdMemorySize) ,r1) /* memory size arg1 */\r
- LoadConstantToReg (FixedPcdGet32(PcdMemoryBase) ,r0) /* memory size arg0 */\r
+// LoadConstantToReg (FixedPcdGet32(PcdMemoryBase) ,r0) Done above \r
blx CEntryPoint /* Assume C code is thumb */\r
\r
ShouldNeverGetHere\r