1 // SPDX-License-Identifier: GPL-2.0 2 // Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd. 3 4 #include <linux/spinlock.h> 5 #include <asm/cache.h> 6 #include <abi/reg_ops.h> 7 8 /* for L1-cache */ 9 #define INS_CACHE (1 << 0) 10 #define DATA_CACHE (1 << 1) 11 #define CACHE_INV (1 << 4) 12 #define CACHE_CLR (1 << 5) 13 #define CACHE_OMS (1 << 6) 14 #define CACHE_ITS (1 << 7) 15 #define CACHE_LICF (1 << 31) 16 17 /* for L2-cache */ 18 #define CR22_LEVEL_SHIFT (1) 19 #define CR22_SET_SHIFT (7) 20 #define CR22_WAY_SHIFT (30) 21 #define CR22_WAY_SHIFT_L2 (29) 22 23 static DEFINE_SPINLOCK(cache_lock); 24 25 static inline void cache_op_line(unsigned long i, unsigned int val) 26 { 27 mtcr("cr22", i); 28 mtcr("cr17", val); 29 } 30 31 #define CCR2_L2E (1 << 3) 32 static void cache_op_all(unsigned int value, unsigned int l2) 33 { 34 mtcr("cr17", value | CACHE_CLR); 35 mb(); 36 37 if (l2 && (mfcr_ccr2() & CCR2_L2E)) { 38 mtcr("cr24", value | CACHE_CLR); 39 mb(); 40 } 41 } 42 43 static void cache_op_range( 44 unsigned int start, 45 unsigned int end, 46 unsigned int value, 47 unsigned int l2) 48 { 49 unsigned long i, flags; 50 unsigned int val = value | CACHE_CLR | CACHE_OMS; 51 bool l2_sync; 52 53 if (unlikely((end - start) >= PAGE_SIZE) || 54 unlikely(start < PAGE_OFFSET) || 55 unlikely(start >= PAGE_OFFSET + LOWMEM_LIMIT)) { 56 cache_op_all(value, l2); 57 return; 58 } 59 60 if ((mfcr_ccr2() & CCR2_L2E) && l2) 61 l2_sync = 1; 62 else 63 l2_sync = 0; 64 65 spin_lock_irqsave(&cache_lock, flags); 66 67 i = start & ~(L1_CACHE_BYTES - 1); 68 for (; i < end; i += L1_CACHE_BYTES) { 69 cache_op_line(i, val); 70 if (l2_sync) { 71 mb(); 72 mtcr("cr24", val); 73 } 74 } 75 spin_unlock_irqrestore(&cache_lock, flags); 76 77 mb(); 78 } 79 80 void dcache_wb_line(unsigned long start) 81 { 82 asm volatile("idly4\n":::"memory"); 83 cache_op_line(start, DATA_CACHE|CACHE_CLR); 84 mb(); 85 } 86 87 void icache_inv_range(unsigned long start, unsigned long end) 88 { 89 cache_op_range(start, end, INS_CACHE|CACHE_INV, 0); 90 } 91 92 void icache_inv_all(void) 93 { 94 cache_op_all(INS_CACHE|CACHE_INV, 0); 95 } 96 97 void dcache_wb_range(unsigned long start, unsigned long end) 98 { 99 cache_op_range(start, end, DATA_CACHE|CACHE_CLR, 0); 100 } 101 102 void dcache_wbinv_all(void) 103 { 104 cache_op_all(DATA_CACHE|CACHE_CLR|CACHE_INV, 0); 105 } 106 107 void cache_wbinv_range(unsigned long start, unsigned long end) 108 { 109 cache_op_range(start, end, INS_CACHE|DATA_CACHE|CACHE_CLR|CACHE_INV, 0); 110 } 111 EXPORT_SYMBOL(cache_wbinv_range); 112 113 void cache_wbinv_all(void) 114 { 115 cache_op_all(INS_CACHE|DATA_CACHE|CACHE_CLR|CACHE_INV, 0); 116 } 117 118 void dma_wbinv_range(unsigned long start, unsigned long end) 119 { 120 cache_op_range(start, end, DATA_CACHE|CACHE_CLR|CACHE_INV, 1); 121 } 122 123 void dma_inv_range(unsigned long start, unsigned long end) 124 { 125 cache_op_range(start, end, DATA_CACHE|CACHE_CLR|CACHE_INV, 1); 126 } 127 128 void dma_wb_range(unsigned long start, unsigned long end) 129 { 130 cache_op_range(start, end, DATA_CACHE|CACHE_CLR|CACHE_INV, 1); 131 } 132