[rtems commit] D-cache clean&&invalidate for Tiny6410

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    76de8a8e6b3fb2f1e4f66a477a2d18e38edd595d
Changeset: http://git.rtems.org/rtems/commit/?id=76de8a8e6b3fb2f1e4f66a477a2d18e38edd595d

Author:    Peng Fan <van.freenix at gmail.com>
Date:      Wed Apr 17 20:54:05 2013 +0800

D-cache clean&&invalidate for Tiny6410

---

 c/src/lib/libcpu/arm/shared/include/arm-cp15.h |   21 +++++++++++++++++++++
 1 files changed, 21 insertions(+), 0 deletions(-)

diff --git a/c/src/lib/libcpu/arm/shared/include/arm-cp15.h b/c/src/lib/libcpu/arm/shared/include/arm-cp15.h
index 3edc83f..017c0e3 100644
--- a/c/src/lib/libcpu/arm/shared/include/arm-cp15.h
+++ b/c/src/lib/libcpu/arm/shared/include/arm-cp15.h
@@ -609,6 +609,27 @@ static inline void arm_cp15_data_cache_test_and_clean(void)
   );
 }
 
+/*	In DDI0301H_arm1176jzfs_r0p7_trm
+ * 	'MCR p15, 0, <Rd>, c7, c14, 0' means
+ * 	Clean and Invalidate Entire Data Cache
+ */
+static inline void arm_cp15_data_cache_clean_and_invalidate(void)
+{
+  ARM_SWITCH_REGISTERS;
+
+  uint32_t sbz = 0;
+
+  __asm__ volatile (
+    ARM_SWITCH_TO_ARM
+    "mcr p15, 0, %[sbz], c7, c14, 0\n"
+    ARM_SWITCH_BACK
+    : ARM_SWITCH_OUTPUT
+    : [sbz] "r" (sbz)
+    : "memory"
+  );
+
+}
+
 static inline void arm_cp15_data_cache_clean_and_invalidate_line(const void *mva)
 {
   ARM_SWITCH_REGISTERS;