bl SET_SA @ sense amp settings
bl __cpu_early_init
- msr cpsr_c, #(USR_MODE | PSR_F_BIT | PSR_I_BIT | SVC26_MODE)
+ msr cpsr_c, #(SVC_MODE | PSR_F_BIT | PSR_I_BIT) @ ensure svc mode and IRQs disabled
ldr r0,=0x0050078
mcr p15,0,r0,c1,c0,0 //; WCP15_SCTLR r2
ISB @ macro for "isb sy" because compiler may not support opcode