A bit of a success :-)

[ms2-kexec] / proc-v7.S

diff --git a/proc-v7.S b/proc-v7.S
index 402ec2b11aa86b59ed93b89a32324ed57e349e59..fe7ffedc40c35d4d4281fc50e0271c76ed34230c 100644 (file)
--- a/proc-v7.S
+++ b/proc-v7.S
@@ -43,10 +43,14 @@ ENTRY(cpu_v7_proc_init)
 ENDPROC(cpu_v7_proc_init)
 
 ENTRY(cpu_v7_proc_fin)
+       stmfd   sp!, {lr}
+       bl      v7_flush_kern_cache_all
        mrc     p15, 0, r0, c1, c0, 0           @ ctrl register
        bic     r0, r0, #0x1000                 @ ...i............
        bic     r0, r0, #0x0006                 @ .............ca.
        mcr     p15, 0, r0, c1, c0, 0           @ disable caches
+       mcr     p15, 0, ip, c8, c7, 0           @ invalidate I & D TLBs
+       ldmfd   sp!, {pc}
        mov     pc, lr
 ENDPROC(cpu_v7_proc_fin)