|
@@ -144,8 +144,13 @@ static void dcscb_power_down(void)
|
|
|
* Let's do it in the safest possible way i.e. with
|
|
|
* no memory access within the following sequence
|
|
|
* including to the stack.
|
|
|
+ *
|
|
|
+ * Note: fp is preserved to the stack explicitly prior doing
|
|
|
+ * this since adding it to the clobber list is incompatible
|
|
|
+ * with having CONFIG_FRAME_POINTER=y.
|
|
|
*/
|
|
|
asm volatile(
|
|
|
+ "str fp, [sp, #-4]! \n\t"
|
|
|
"mrc p15, 0, r0, c1, c0, 0 @ get CR \n\t"
|
|
|
"bic r0, r0, #"__stringify(CR_C)" \n\t"
|
|
|
"mcr p15, 0, r0, c1, c0, 0 @ set CR \n\t"
|
|
@@ -156,9 +161,10 @@ static void dcscb_power_down(void)
|
|
|
"bic r0, r0, #(1 << 6) @ disable local coherency \n\t"
|
|
|
"mcr p15, 0, r0, c1, c0, 1 @ set AUXCR \n\t"
|
|
|
"isb \n\t"
|
|
|
- "dsb "
|
|
|
+ "dsb \n\t"
|
|
|
+ "ldr fp, [sp], #4"
|
|
|
: : : "r0","r1","r2","r3","r4","r5","r6","r7",
|
|
|
- "r9","r10","r11","lr","memory");
|
|
|
+ "r9","r10","lr","memory");
|
|
|
|
|
|
/*
|
|
|
* This is a harmless no-op. On platforms with a real
|
|
@@ -182,6 +188,7 @@ static void dcscb_power_down(void)
|
|
|
* Let's do it in the safest possible way as above.
|
|
|
*/
|
|
|
asm volatile(
|
|
|
+ "str fp, [sp, #-4]! \n\t"
|
|
|
"mrc p15, 0, r0, c1, c0, 0 @ get CR \n\t"
|
|
|
"bic r0, r0, #"__stringify(CR_C)" \n\t"
|
|
|
"mcr p15, 0, r0, c1, c0, 0 @ set CR \n\t"
|
|
@@ -192,9 +199,10 @@ static void dcscb_power_down(void)
|
|
|
"bic r0, r0, #(1 << 6) @ disable local coherency \n\t"
|
|
|
"mcr p15, 0, r0, c1, c0, 1 @ set AUXCR \n\t"
|
|
|
"isb \n\t"
|
|
|
- "dsb "
|
|
|
+ "dsb \n\t"
|
|
|
+ "ldr fp, [sp], #4"
|
|
|
: : : "r0","r1","r2","r3","r4","r5","r6","r7",
|
|
|
- "r9","r10","r11","lr","memory");
|
|
|
+ "r9","r10","lr","memory");
|
|
|
}
|
|
|
|
|
|
__mcpm_cpu_down(cpu, cluster);
|