More EcuM Sleep changes. Need RC2 of tools

[arc.git] / arch / ppc / mpc55xx / drivers / Mcu_Sleep.sx

diff --git a/arch/ppc/mpc55xx/drivers/Mcu_Sleep.sx b/arch/ppc/mpc55xx/drivers/Mcu_Sleep.sx
index 9f6d4919b6c8cb3e21d200997164ea6614b6ab45..d79c8d001393a63fe3b93b67b5db504142d79c0c 100644 (file)
--- a/arch/ppc/mpc55xx/drivers/Mcu_Sleep.sx
+++ b/arch/ppc/mpc55xx/drivers/Mcu_Sleep.sx
@@ -102,8 +102,6 @@ McuE_LowPowerRecoverFlash:
        mtCR    r29\r
        mtXER   r30\r
        mtCTR   r31                 // Load SPRs with GPR values\r
-       lmw     r2, 0(r1)           // Restore GPRs from stack\r
-       addi    r1,r1,0x94      // Deallocate space on stack\r
 \r
 #if defined(USE_ECUM)\r
 \r
@@ -112,8 +110,10 @@ McuE_LowPowerRecoverFlash:
        bl EcuM_CheckWakeup\r
 \r
 #endif\r
+       mtLR    r27\r
 \r
-\r
+       lmw     r2, 0(r1)           // Restore GPRs from stack\r
+       addi    r1,r1,0x94      // Deallocate space on stack\r
 \r
     /* branch back to Mcu_SetMode().. */\r
     blr\r