[bsp][cvitek] add dcache opration functions for cache coherence

Author: zdtyuiop4444

bsp/cvitek/c906_little/board/arch_helpers.h

@@ -0,0 +1,12 @@
+#ifndef __ARCH_HELPERS_H__
+#define __ARCH_HELPERS_H__
+#include <stdint.h>
+#include <sys/types.h>
+
+void flush_dcache_range(uintptr_t addr, size_t size);
+void clean_dcache_range(uintptr_t addr, size_t size);
+void inv_dcache_range(uintptr_t addr, size_t size);
+void enable_dcache(void);
+void disable_dcache(void);
+
+#endif /* __ARCH_HELPERS_H__ */

bsp/cvitek/c906_little/board/cache.c

@@ -0,0 +1,56 @@
+// #include <platform.h>
+#include "arch_helpers.h"
+
+// typedef uint64_t phys_addr_t;
+// typedef uintptr_t       size_t;
+
+#define L1_CACHE_BYTES 64
+#define ALIGN(x, a) (((x) + (a) - 1) & ~((a) - 1))
+
+/*
+ * dcache.ipa rs1 (invalidate)
+ * | 31 - 25 | 24 - 20 | 19 - 15 | 14 - 12 | 11 - 7 | 6 - 0 |
+ *   0000001    01010      rs1       000      00000  0001011
+ *
+ * dcache.cpa rs1 (clean)
+ * | 31 - 25 | 24 - 20 | 19 - 15 | 14 - 12 | 11 - 7 | 6 - 0 |
+ *   0000001    01001      rs1       000      00000  0001011
+ *
+ * dcache.cipa rs1 (clean then invalidate)
+ * | 31 - 25 | 24 - 20 | 19 - 15 | 14 - 12 | 11 - 7 | 6 - 0 |
+ *   0000001    01011      rs1       000      00000  0001011
+ *
+ * sync.s
+ * | 31 - 25 | 24 - 20 | 19 - 15 | 14 - 12 | 11 - 7 | 6 - 0 |
+ *   0000000    11001     00000      000      00000  0001011
+ */
+#define DCACHE_IPA_A0 ".long 0x02a5000b"
+#define DCACHE_CPA_A0 ".long 0x0295000b"
+#define DCACHE_CIPA_A0 ".long 0x02b5000b"
+
+#define SYNC_S ".long 0x0190000b"
+
+#define CACHE_OP_RANGE(OP, start, size)                                        \
+    register unsigned long i asm("a0") = start & ~(L1_CACHE_BYTES - 1);        \
+    for (; i < ALIGN(start + size, L1_CACHE_BYTES); i += L1_CACHE_BYTES)       \
+        __asm__ __volatile__(OP);                                              \
+    __asm__ __volatile__(SYNC_S)
+
+// void c900_cache_invalidate(phys_addr_t start, size_t size)
+inline void inv_dcache_range(uintptr_t start, size_t size) {
+    CACHE_OP_RANGE(DCACHE_IPA_A0, start, size);
+}
+
+// void c900_cache_clean(phys_addr_t start, size_t size)
+inline void clean_dcache_range(uintptr_t start, size_t size) {
+    CACHE_OP_RANGE(DCACHE_CPA_A0, start, size);
+}
+
+// void c900_cache_flush(phys_addr_t start, size_t size)
+inline void flush_dcache_range(uintptr_t start, size_t size) {
+    CACHE_OP_RANGE(DCACHE_CIPA_A0, start, size);
+}
+
+inline void enable_dcache(void) { asm volatile("csrs mhcr, %0;" ::"rI"(0x2)); }
+
+inline void disable_dcache(void) { asm volatile("csrc mhcr, %0;" ::"rI"(0x2)); }