svc_access_control[3]=0x3FFFFFFF;
}
-
-static void ctr_invalidate_ICache_kernel(void)
-{
- __asm__ volatile(
- "cpsid aif\n\t"
- "mov r0, #0\n\t"
- "mcr p15, 0, r0, c7, c5, 0\n\t");
-}
-
-static void ctr_flush_DCache_kernel(void)
-{
- __asm__ volatile(
- "cpsid aif\n\t"
- "mov r0, #0\n\t"
- "mcr p15, 0, r0, c7, c10, 0\n\t");
-
-}
-
-
static void ctr_enable_all_svc(void)
{
svcBackdoor((ctr_callback_type)ctr_enable_all_svc_kernel);
}
-void ctr_invalidate_ICache(void)
+static void ctr_clean_invalidate_kernel(void)
{
-// __asm__ volatile("svc 0x2E\n\t");
- svcBackdoor((ctr_callback_type)ctr_invalidate_ICache_kernel);
-
-}
-
-void ctr_flush_DCache(void)
-{
-// __asm__ volatile("svc 0x4B\n\t");
- svcBackdoor((ctr_callback_type)ctr_flush_DCache_kernel);
+ __asm__ volatile(
+ "mrs r1, cpsr\n"
+ "cpsid aif\n" // disable interrupts
+ "mov r0, #0\n"
+ "mcr p15, 0, r0, c7, c10, 0\n" // clean dcache
+ "mcr p15, 0, r0, c7, c10, 4\n" // DSB
+ "mcr p15, 0, r0, c7, c5, 0\n" // invalidate icache+BTAC
+ "msr cpsr_cx, r1\n" // restore interrupts
+ ::: "r0", "r1");
}
-
void ctr_flush_invalidate_cache(void)
{
- ctr_flush_DCache();
- ctr_invalidate_ICache();
+// __asm__ volatile("svc 0x2E\n\t");
+// __asm__ volatile("svc 0x4B\n\t");
+ svcBackdoor((ctr_callback_type)ctr_clean_invalidate_kernel);
}
int ctr_svchack_init(void)