arm64: zynqmp: Enable ttcs for zc1751 dc5

[u-boot] / arch / arm / mach-mvebu / lowlevel_spl.S

diff --git a/arch/arm/mach-mvebu/lowlevel_spl.S b/arch/arm/mach-mvebu/lowlevel_spl.S
index 69da7fe7afd6ced7a689032ed3ce5ccd32f1cbf5..49e0b906d583f52ad89fe48b98bd639ec1480241 100644 (file)
--- a/arch/arm/mach-mvebu/lowlevel_spl.S
+++ b/arch/arm/mach-mvebu/lowlevel_spl.S
@@ -6,9 +6,19 @@
 #include <linux/linkage.h>
 
 ENTRY(save_boot_params)
+       stmfd   sp!, {r0 - r12, lr}     /* @ save registers on stack */
+       ldr     r12, =CONFIG_SPL_BOOTROM_SAVE
+       str     sp, [r12]
        b       save_boot_params_ret
 ENDPROC(save_boot_params)
 
+ENTRY(return_to_bootrom)
+       ldr     r12, =CONFIG_SPL_BOOTROM_SAVE
+       ldr     sp, [r12]
+       mov     r0, #0x0                /* @ return value: 0x0 NO_ERR */
+       ldmfd   sp!, {r0 - r12, pc}     /* @ restore regs and return */
+ENDPROC(return_to_bootrom)
+
 /*
  * cache_inv - invalidate Cache line
  * r0 - dest