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 
cache_op_line(unsigned long i,unsigned int val)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)
cache_op_all(unsigned int value,unsigned int l2)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 
cache_op_range(unsigned int start,unsigned int end,unsigned int value,unsigned int l2)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 
dcache_wb_line(unsigned long start)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 
icache_inv_range(unsigned long start,unsigned long end)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 
icache_inv_all(void)92 void icache_inv_all(void)
93 {
94 	cache_op_all(INS_CACHE|CACHE_INV, 0);
95 }
96 
local_icache_inv_all(void * priv)97 void local_icache_inv_all(void *priv)
98 {
99 	cache_op_all(INS_CACHE|CACHE_INV, 0);
100 }
101 
dcache_wb_range(unsigned long start,unsigned long end)102 void dcache_wb_range(unsigned long start, unsigned long end)
103 {
104 	cache_op_range(start, end, DATA_CACHE|CACHE_CLR, 0);
105 }
106 
dcache_wbinv_all(void)107 void dcache_wbinv_all(void)
108 {
109 	cache_op_all(DATA_CACHE|CACHE_CLR|CACHE_INV, 0);
110 }
111 
cache_wbinv_range(unsigned long start,unsigned long end)112 void cache_wbinv_range(unsigned long start, unsigned long end)
113 {
114 	cache_op_range(start, end, INS_CACHE|DATA_CACHE|CACHE_CLR|CACHE_INV, 0);
115 }
116 EXPORT_SYMBOL(cache_wbinv_range);
117 
cache_wbinv_all(void)118 void cache_wbinv_all(void)
119 {
120 	cache_op_all(INS_CACHE|DATA_CACHE|CACHE_CLR|CACHE_INV, 0);
121 }
122 
dma_wbinv_range(unsigned long start,unsigned long end)123 void dma_wbinv_range(unsigned long start, unsigned long end)
124 {
125 	cache_op_range(start, end, DATA_CACHE|CACHE_CLR|CACHE_INV, 1);
126 }
127 
dma_inv_range(unsigned long start,unsigned long end)128 void dma_inv_range(unsigned long start, unsigned long end)
129 {
130 	cache_op_range(start, end, DATA_CACHE|CACHE_CLR|CACHE_INV, 1);
131 }
132 
dma_wb_range(unsigned long start,unsigned long end)133 void dma_wb_range(unsigned long start, unsigned long end)
134 {
135 	cache_op_range(start, end, DATA_CACHE|CACHE_CLR|CACHE_INV, 1);
136 }
137