[PATCH v2 2/5] kvx: Implement dcache invalidation primitive

[Jules Maselbas]

From: Yann Sionneau <ysionneau at kalray.eu>

Signed-off-by: Jules Maselbas <jmaselbas at kalray.eu>
---
changes v1 -> v2:
 - renamed kvx_dcache_invalidate_mem_area to invalidate_dcache_range
 - replace the implemetation with a simpler version
---
 arch/kvx/Kconfig             |  1 +
 arch/kvx/include/asm/cache.h | 13 +++++++++++++
 arch/kvx/lib/Makefile        |  2 +-
 arch/kvx/lib/cache.c         | 25 +++++++++++++++++++++++++
 4 files changed, 40 insertions(+), 1 deletion(-)
 create mode 100644 arch/kvx/lib/cache.c

diff --git a/arch/kvx/Kconfig b/arch/kvx/Kconfig
index 8483ae6e6..4e02613ec 100644
--- a/arch/kvx/Kconfig
+++ b/arch/kvx/Kconfig
@@ -12,6 +12,7 @@ config KVX
 	select FLEXIBLE_BOOTARGS
 	select GENERIC_FIND_NEXT_BIT
 	select HAS_ARCH_SJLJ
+	select HAS_CACHE
 	select LIBFDT
 	select MFD_SYSCON
 	select OF_BAREBOX_DRIVERS
diff --git a/arch/kvx/include/asm/cache.h b/arch/kvx/include/asm/cache.h
index 3be176725..0bf3c8f06 100644
--- a/arch/kvx/include/asm/cache.h
+++ b/arch/kvx/include/asm/cache.h
@@ -8,6 +8,8 @@
 
 #include <linux/types.h>
 
+void invalidate_dcache_range(unsigned long addr, unsigned long stop);
+
 static inline void sync_caches_for_execution(void)
 {
 	__builtin_kvx_fence();
@@ -15,4 +17,15 @@ static inline void sync_caches_for_execution(void)
 	__builtin_kvx_barrier();
 }
 
+static inline void sync_dcache_icache(void)
+{
+	sync_caches_for_execution();
+}
+
+static inline void dcache_inval(void)
+{
+	__builtin_kvx_fence();
+	__builtin_kvx_dinval();
+}
+
 #endif /* __KVX_CACHE_H */
diff --git a/arch/kvx/lib/Makefile b/arch/kvx/lib/Makefile
index cee08b0fa..d271ebccf 100644
--- a/arch/kvx/lib/Makefile
+++ b/arch/kvx/lib/Makefile
@@ -3,4 +3,4 @@
 # Copyright (C) 2019 Kalray Inc.
 #
 
-obj-y	+= cpuinfo.o board.o dtb.o poweroff.o bootm.o setjmp.o
+obj-y	+= cpuinfo.o board.o dtb.o poweroff.o bootm.o setjmp.o cache.o
diff --git a/arch/kvx/lib/cache.c b/arch/kvx/lib/cache.c
new file mode 100644
index 000000000..bd074de79
--- /dev/null
+++ b/arch/kvx/lib/cache.c
@@ -0,0 +1,25 @@
+// SPDX-License-Identifier: GPL-2.0-only
+// SPDX-FileCopyrightText: 2021 Yann Sionneau <ysionneau at kalray.eu>, Kalray Inc.
+
+#include <asm/cache.h>
+#include <linux/kernel.h>
+
+#define KVX_DCACHE_LINE_SIZE    (64)
+#define KVX_DCACHE_SIZE (128*1024)
+
+void invalidate_dcache_range(unsigned long addr, unsigned long stop)
+{
+	long size;
+
+	addr = ALIGN_DOWN(addr, KVX_DCACHE_LINE_SIZE);
+	size = stop - addr;
+
+	if (size < KVX_DCACHE_SIZE) {
+		while (addr < stop) {
+			__builtin_kvx_dinvall((void *)addr);
+			addr += KVX_DCACHE_LINE_SIZE;
+		}
+	} else {
+		__builtin_kvx_dinval();
+	}
+}
-- 
2.17.1