MIPS: c-r4k: Invalidate BMIPS5000 ZSCM prefetch lines

Zephyr secondary cache is 256KB, 128B lines. 32B sectors. A secondary cache
line can contain two instruction cache lines (64B), or four data cache
lines (32B). Hardware prefetch Cache detects stream access, and prefetches
ahead of processor access. Add support to invalidate BMIPS5000 cpu zephyr
secondary cache module (ZSCM) on DMA from device so that data returned is
coherent during DMA read operations.

Signed-off-by: Kamal Dasu <kdasu.kdev@gmail.com>
Reviewed-by: Florian Fainelli <f.fainelli@gmail.com>
Signed-off-by: Thomas Bogendoerfer <tsbogend@alpha.franken.de>

diff --git a/arch/mips/mm/c-r4k.c b/arch/mips/mm/c-r4k.c
index 3472f6deaf923a35f6b2482fe91103de40063e78..36a3113487393383c1ed7db98855b629cd0f3bba 100644 (file)
--- a/arch/mips/mm/c-r4k.c
+++ b/arch/mips/mm/c-r4k.c
@@ -901,6 +901,31 @@ static void r4k_dma_cache_wback_inv(unsigned long addr, unsigned long size)
        __sync();
 }
 
+static void prefetch_cache_inv(unsigned long addr, unsigned long size)
+{
+       unsigned int linesz = cpu_scache_line_size();
+       unsigned long addr0 = addr, addr1;
+
+       addr0 &= ~(linesz - 1);
+       addr1 = (addr0 + size - 1) & ~(linesz - 1);
+
+       protected_writeback_scache_line(addr0);
+       if (likely(addr1 != addr0))
+               protected_writeback_scache_line(addr1);
+       else
+               return;
+
+       addr0 += linesz;
+       if (likely(addr1 != addr0))
+               protected_writeback_scache_line(addr0);
+       else
+               return;
+
+       addr1 -= linesz;
+       if (likely(addr1 > addr0))
+               protected_writeback_scache_line(addr0);
+}
+
 static void r4k_dma_cache_inv(unsigned long addr, unsigned long size)
 {
        /* Catch bad driver code */
@@ -908,6 +933,10 @@ static void r4k_dma_cache_inv(unsigned long addr, unsigned long size)
                return;
 
        preempt_disable();
+
+       if (current_cpu_type() == CPU_BMIPS5000)
+               prefetch_cache_inv(addr, size);
+
        if (cpu_has_inclusive_pcaches) {
                if (size >= scache_size) {
                        if (current_cpu_type() != CPU_LOONGSON64)