1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * This file is subject to the terms and conditions of the GNU General Public
3*4882a593Smuzhiyun * License. See the file "COPYING" in the main directory of this archive
4*4882a593Smuzhiyun * for more details.
5*4882a593Smuzhiyun *
6*4882a593Smuzhiyun * Copyright (C) 2003, 04, 05 Ralf Baechle (ralf@linux-mips.org)
7*4882a593Smuzhiyun * Copyright (C) 2007 Maciej W. Rozycki
8*4882a593Smuzhiyun * Copyright (C) 2008 Thiemo Seufer
9*4882a593Smuzhiyun * Copyright (C) 2012 MIPS Technologies, Inc.
10*4882a593Smuzhiyun */
11*4882a593Smuzhiyun #include <linux/kernel.h>
12*4882a593Smuzhiyun #include <linux/sched.h>
13*4882a593Smuzhiyun #include <linux/smp.h>
14*4882a593Smuzhiyun #include <linux/mm.h>
15*4882a593Smuzhiyun #include <linux/proc_fs.h>
16*4882a593Smuzhiyun
17*4882a593Smuzhiyun #include <asm/bugs.h>
18*4882a593Smuzhiyun #include <asm/cacheops.h>
19*4882a593Smuzhiyun #include <asm/cpu-type.h>
20*4882a593Smuzhiyun #include <asm/inst.h>
21*4882a593Smuzhiyun #include <asm/io.h>
22*4882a593Smuzhiyun #include <asm/page.h>
23*4882a593Smuzhiyun #include <asm/prefetch.h>
24*4882a593Smuzhiyun #include <asm/bootinfo.h>
25*4882a593Smuzhiyun #include <asm/mipsregs.h>
26*4882a593Smuzhiyun #include <asm/mmu_context.h>
27*4882a593Smuzhiyun #include <asm/cpu.h>
28*4882a593Smuzhiyun #include <asm/war.h>
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun #ifdef CONFIG_SIBYTE_DMA_PAGEOPS
31*4882a593Smuzhiyun #include <asm/sibyte/sb1250.h>
32*4882a593Smuzhiyun #include <asm/sibyte/sb1250_regs.h>
33*4882a593Smuzhiyun #include <asm/sibyte/sb1250_dma.h>
34*4882a593Smuzhiyun #endif
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun #include <asm/uasm.h>
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun /* Registers used in the assembled routines. */
39*4882a593Smuzhiyun #define ZERO 0
40*4882a593Smuzhiyun #define AT 2
41*4882a593Smuzhiyun #define A0 4
42*4882a593Smuzhiyun #define A1 5
43*4882a593Smuzhiyun #define A2 6
44*4882a593Smuzhiyun #define T0 8
45*4882a593Smuzhiyun #define T1 9
46*4882a593Smuzhiyun #define T2 10
47*4882a593Smuzhiyun #define T3 11
48*4882a593Smuzhiyun #define T9 25
49*4882a593Smuzhiyun #define RA 31
50*4882a593Smuzhiyun
51*4882a593Smuzhiyun /* Handle labels (which must be positive integers). */
52*4882a593Smuzhiyun enum label_id {
53*4882a593Smuzhiyun label_clear_nopref = 1,
54*4882a593Smuzhiyun label_clear_pref,
55*4882a593Smuzhiyun label_copy_nopref,
56*4882a593Smuzhiyun label_copy_pref_both,
57*4882a593Smuzhiyun label_copy_pref_store,
58*4882a593Smuzhiyun };
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun UASM_L_LA(_clear_nopref)
61*4882a593Smuzhiyun UASM_L_LA(_clear_pref)
62*4882a593Smuzhiyun UASM_L_LA(_copy_nopref)
63*4882a593Smuzhiyun UASM_L_LA(_copy_pref_both)
64*4882a593Smuzhiyun UASM_L_LA(_copy_pref_store)
65*4882a593Smuzhiyun
66*4882a593Smuzhiyun /* We need one branch and therefore one relocation per target label. */
67*4882a593Smuzhiyun static struct uasm_label labels[5];
68*4882a593Smuzhiyun static struct uasm_reloc relocs[5];
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun #define cpu_is_r4600_v1_x() ((read_c0_prid() & 0xfffffff0) == 0x00002010)
71*4882a593Smuzhiyun #define cpu_is_r4600_v2_x() ((read_c0_prid() & 0xfffffff0) == 0x00002020)
72*4882a593Smuzhiyun
73*4882a593Smuzhiyun /*
74*4882a593Smuzhiyun * R6 has a limited offset of the pref instruction.
75*4882a593Smuzhiyun * Skip it if the offset is more than 9 bits.
76*4882a593Smuzhiyun */
77*4882a593Smuzhiyun #define _uasm_i_pref(a, b, c, d) \
78*4882a593Smuzhiyun do { \
79*4882a593Smuzhiyun if (cpu_has_mips_r6) { \
80*4882a593Smuzhiyun if (c <= 0xff && c >= -0x100) \
81*4882a593Smuzhiyun uasm_i_pref(a, b, c, d);\
82*4882a593Smuzhiyun } else { \
83*4882a593Smuzhiyun uasm_i_pref(a, b, c, d); \
84*4882a593Smuzhiyun } \
85*4882a593Smuzhiyun } while(0)
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun static int pref_bias_clear_store;
88*4882a593Smuzhiyun static int pref_bias_copy_load;
89*4882a593Smuzhiyun static int pref_bias_copy_store;
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun static u32 pref_src_mode;
92*4882a593Smuzhiyun static u32 pref_dst_mode;
93*4882a593Smuzhiyun
94*4882a593Smuzhiyun static int clear_word_size;
95*4882a593Smuzhiyun static int copy_word_size;
96*4882a593Smuzhiyun
97*4882a593Smuzhiyun static int half_clear_loop_size;
98*4882a593Smuzhiyun static int half_copy_loop_size;
99*4882a593Smuzhiyun
100*4882a593Smuzhiyun static int cache_line_size;
101*4882a593Smuzhiyun #define cache_line_mask() (cache_line_size - 1)
102*4882a593Smuzhiyun
103*4882a593Smuzhiyun static inline void
pg_addiu(u32 ** buf,unsigned int reg1,unsigned int reg2,unsigned int off)104*4882a593Smuzhiyun pg_addiu(u32 **buf, unsigned int reg1, unsigned int reg2, unsigned int off)
105*4882a593Smuzhiyun {
106*4882a593Smuzhiyun if (cpu_has_64bit_gp_regs && DADDI_WAR && r4k_daddiu_bug()) {
107*4882a593Smuzhiyun if (off > 0x7fff) {
108*4882a593Smuzhiyun uasm_i_lui(buf, T9, uasm_rel_hi(off));
109*4882a593Smuzhiyun uasm_i_addiu(buf, T9, T9, uasm_rel_lo(off));
110*4882a593Smuzhiyun } else
111*4882a593Smuzhiyun uasm_i_addiu(buf, T9, ZERO, off);
112*4882a593Smuzhiyun uasm_i_daddu(buf, reg1, reg2, T9);
113*4882a593Smuzhiyun } else {
114*4882a593Smuzhiyun if (off > 0x7fff) {
115*4882a593Smuzhiyun uasm_i_lui(buf, T9, uasm_rel_hi(off));
116*4882a593Smuzhiyun uasm_i_addiu(buf, T9, T9, uasm_rel_lo(off));
117*4882a593Smuzhiyun UASM_i_ADDU(buf, reg1, reg2, T9);
118*4882a593Smuzhiyun } else
119*4882a593Smuzhiyun UASM_i_ADDIU(buf, reg1, reg2, off);
120*4882a593Smuzhiyun }
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun
set_prefetch_parameters(void)123*4882a593Smuzhiyun static void set_prefetch_parameters(void)
124*4882a593Smuzhiyun {
125*4882a593Smuzhiyun if (cpu_has_64bit_gp_regs || cpu_has_64bit_zero_reg)
126*4882a593Smuzhiyun clear_word_size = 8;
127*4882a593Smuzhiyun else
128*4882a593Smuzhiyun clear_word_size = 4;
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun if (cpu_has_64bit_gp_regs)
131*4882a593Smuzhiyun copy_word_size = 8;
132*4882a593Smuzhiyun else
133*4882a593Smuzhiyun copy_word_size = 4;
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun /*
136*4882a593Smuzhiyun * The pref's used here are using "streaming" hints, which cause the
137*4882a593Smuzhiyun * copied data to be kicked out of the cache sooner. A page copy often
138*4882a593Smuzhiyun * ends up copying a lot more data than is commonly used, so this seems
139*4882a593Smuzhiyun * to make sense in terms of reducing cache pollution, but I've no real
140*4882a593Smuzhiyun * performance data to back this up.
141*4882a593Smuzhiyun */
142*4882a593Smuzhiyun if (cpu_has_prefetch) {
143*4882a593Smuzhiyun /*
144*4882a593Smuzhiyun * XXX: Most prefetch bias values in here are based on
145*4882a593Smuzhiyun * guesswork.
146*4882a593Smuzhiyun */
147*4882a593Smuzhiyun cache_line_size = cpu_dcache_line_size();
148*4882a593Smuzhiyun switch (current_cpu_type()) {
149*4882a593Smuzhiyun case CPU_R5500:
150*4882a593Smuzhiyun case CPU_TX49XX:
151*4882a593Smuzhiyun /* These processors only support the Pref_Load. */
152*4882a593Smuzhiyun pref_bias_copy_load = 256;
153*4882a593Smuzhiyun break;
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun case CPU_R10000:
156*4882a593Smuzhiyun case CPU_R12000:
157*4882a593Smuzhiyun case CPU_R14000:
158*4882a593Smuzhiyun case CPU_R16000:
159*4882a593Smuzhiyun /*
160*4882a593Smuzhiyun * Those values have been experimentally tuned for an
161*4882a593Smuzhiyun * Origin 200.
162*4882a593Smuzhiyun */
163*4882a593Smuzhiyun pref_bias_clear_store = 512;
164*4882a593Smuzhiyun pref_bias_copy_load = 256;
165*4882a593Smuzhiyun pref_bias_copy_store = 256;
166*4882a593Smuzhiyun pref_src_mode = Pref_LoadStreamed;
167*4882a593Smuzhiyun pref_dst_mode = Pref_StoreStreamed;
168*4882a593Smuzhiyun break;
169*4882a593Smuzhiyun
170*4882a593Smuzhiyun case CPU_SB1:
171*4882a593Smuzhiyun case CPU_SB1A:
172*4882a593Smuzhiyun pref_bias_clear_store = 128;
173*4882a593Smuzhiyun pref_bias_copy_load = 128;
174*4882a593Smuzhiyun pref_bias_copy_store = 128;
175*4882a593Smuzhiyun /*
176*4882a593Smuzhiyun * SB1 pass1 Pref_LoadStreamed/Pref_StoreStreamed
177*4882a593Smuzhiyun * hints are broken.
178*4882a593Smuzhiyun */
179*4882a593Smuzhiyun if (current_cpu_type() == CPU_SB1 &&
180*4882a593Smuzhiyun (current_cpu_data.processor_id & 0xff) < 0x02) {
181*4882a593Smuzhiyun pref_src_mode = Pref_Load;
182*4882a593Smuzhiyun pref_dst_mode = Pref_Store;
183*4882a593Smuzhiyun } else {
184*4882a593Smuzhiyun pref_src_mode = Pref_LoadStreamed;
185*4882a593Smuzhiyun pref_dst_mode = Pref_StoreStreamed;
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun break;
188*4882a593Smuzhiyun
189*4882a593Smuzhiyun case CPU_LOONGSON64:
190*4882a593Smuzhiyun /* Loongson-3 only support the Pref_Load/Pref_Store. */
191*4882a593Smuzhiyun pref_bias_clear_store = 128;
192*4882a593Smuzhiyun pref_bias_copy_load = 128;
193*4882a593Smuzhiyun pref_bias_copy_store = 128;
194*4882a593Smuzhiyun pref_src_mode = Pref_Load;
195*4882a593Smuzhiyun pref_dst_mode = Pref_Store;
196*4882a593Smuzhiyun break;
197*4882a593Smuzhiyun
198*4882a593Smuzhiyun default:
199*4882a593Smuzhiyun pref_bias_clear_store = 128;
200*4882a593Smuzhiyun pref_bias_copy_load = 256;
201*4882a593Smuzhiyun pref_bias_copy_store = 128;
202*4882a593Smuzhiyun pref_src_mode = Pref_LoadStreamed;
203*4882a593Smuzhiyun if (cpu_has_mips_r6)
204*4882a593Smuzhiyun /*
205*4882a593Smuzhiyun * Bit 30 (Pref_PrepareForStore) has been
206*4882a593Smuzhiyun * removed from MIPS R6. Use bit 5
207*4882a593Smuzhiyun * (Pref_StoreStreamed).
208*4882a593Smuzhiyun */
209*4882a593Smuzhiyun pref_dst_mode = Pref_StoreStreamed;
210*4882a593Smuzhiyun else
211*4882a593Smuzhiyun pref_dst_mode = Pref_PrepareForStore;
212*4882a593Smuzhiyun break;
213*4882a593Smuzhiyun }
214*4882a593Smuzhiyun } else {
215*4882a593Smuzhiyun if (cpu_has_cache_cdex_s)
216*4882a593Smuzhiyun cache_line_size = cpu_scache_line_size();
217*4882a593Smuzhiyun else if (cpu_has_cache_cdex_p)
218*4882a593Smuzhiyun cache_line_size = cpu_dcache_line_size();
219*4882a593Smuzhiyun }
220*4882a593Smuzhiyun /*
221*4882a593Smuzhiyun * Too much unrolling will overflow the available space in
222*4882a593Smuzhiyun * clear_space_array / copy_page_array.
223*4882a593Smuzhiyun */
224*4882a593Smuzhiyun half_clear_loop_size = min(16 * clear_word_size,
225*4882a593Smuzhiyun max(cache_line_size >> 1,
226*4882a593Smuzhiyun 4 * clear_word_size));
227*4882a593Smuzhiyun half_copy_loop_size = min(16 * copy_word_size,
228*4882a593Smuzhiyun max(cache_line_size >> 1,
229*4882a593Smuzhiyun 4 * copy_word_size));
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun
build_clear_store(u32 ** buf,int off)232*4882a593Smuzhiyun static void build_clear_store(u32 **buf, int off)
233*4882a593Smuzhiyun {
234*4882a593Smuzhiyun if (cpu_has_64bit_gp_regs || cpu_has_64bit_zero_reg) {
235*4882a593Smuzhiyun uasm_i_sd(buf, ZERO, off, A0);
236*4882a593Smuzhiyun } else {
237*4882a593Smuzhiyun uasm_i_sw(buf, ZERO, off, A0);
238*4882a593Smuzhiyun }
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun
build_clear_pref(u32 ** buf,int off)241*4882a593Smuzhiyun static inline void build_clear_pref(u32 **buf, int off)
242*4882a593Smuzhiyun {
243*4882a593Smuzhiyun if (off & cache_line_mask())
244*4882a593Smuzhiyun return;
245*4882a593Smuzhiyun
246*4882a593Smuzhiyun if (pref_bias_clear_store) {
247*4882a593Smuzhiyun _uasm_i_pref(buf, pref_dst_mode, pref_bias_clear_store + off,
248*4882a593Smuzhiyun A0);
249*4882a593Smuzhiyun } else if (cache_line_size == (half_clear_loop_size << 1)) {
250*4882a593Smuzhiyun if (cpu_has_cache_cdex_s) {
251*4882a593Smuzhiyun uasm_i_cache(buf, Create_Dirty_Excl_SD, off, A0);
252*4882a593Smuzhiyun } else if (cpu_has_cache_cdex_p) {
253*4882a593Smuzhiyun if (IS_ENABLED(CONFIG_WAR_R4600_V1_HIT_CACHEOP) &&
254*4882a593Smuzhiyun cpu_is_r4600_v1_x()) {
255*4882a593Smuzhiyun uasm_i_nop(buf);
256*4882a593Smuzhiyun uasm_i_nop(buf);
257*4882a593Smuzhiyun uasm_i_nop(buf);
258*4882a593Smuzhiyun uasm_i_nop(buf);
259*4882a593Smuzhiyun }
260*4882a593Smuzhiyun
261*4882a593Smuzhiyun if (IS_ENABLED(CONFIG_WAR_R4600_V2_HIT_CACHEOP) &&
262*4882a593Smuzhiyun cpu_is_r4600_v2_x())
263*4882a593Smuzhiyun uasm_i_lw(buf, ZERO, ZERO, AT);
264*4882a593Smuzhiyun
265*4882a593Smuzhiyun uasm_i_cache(buf, Create_Dirty_Excl_D, off, A0);
266*4882a593Smuzhiyun }
267*4882a593Smuzhiyun }
268*4882a593Smuzhiyun }
269*4882a593Smuzhiyun
270*4882a593Smuzhiyun extern u32 __clear_page_start;
271*4882a593Smuzhiyun extern u32 __clear_page_end;
272*4882a593Smuzhiyun extern u32 __copy_page_start;
273*4882a593Smuzhiyun extern u32 __copy_page_end;
274*4882a593Smuzhiyun
build_clear_page(void)275*4882a593Smuzhiyun void build_clear_page(void)
276*4882a593Smuzhiyun {
277*4882a593Smuzhiyun int off;
278*4882a593Smuzhiyun u32 *buf = &__clear_page_start;
279*4882a593Smuzhiyun struct uasm_label *l = labels;
280*4882a593Smuzhiyun struct uasm_reloc *r = relocs;
281*4882a593Smuzhiyun int i;
282*4882a593Smuzhiyun static atomic_t run_once = ATOMIC_INIT(0);
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun if (atomic_xchg(&run_once, 1)) {
285*4882a593Smuzhiyun return;
286*4882a593Smuzhiyun }
287*4882a593Smuzhiyun
288*4882a593Smuzhiyun memset(labels, 0, sizeof(labels));
289*4882a593Smuzhiyun memset(relocs, 0, sizeof(relocs));
290*4882a593Smuzhiyun
291*4882a593Smuzhiyun set_prefetch_parameters();
292*4882a593Smuzhiyun
293*4882a593Smuzhiyun /*
294*4882a593Smuzhiyun * This algorithm makes the following assumptions:
295*4882a593Smuzhiyun * - The prefetch bias is a multiple of 2 words.
296*4882a593Smuzhiyun * - The prefetch bias is less than one page.
297*4882a593Smuzhiyun */
298*4882a593Smuzhiyun BUG_ON(pref_bias_clear_store % (2 * clear_word_size));
299*4882a593Smuzhiyun BUG_ON(PAGE_SIZE < pref_bias_clear_store);
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun off = PAGE_SIZE - pref_bias_clear_store;
302*4882a593Smuzhiyun if (off > 0xffff || !pref_bias_clear_store)
303*4882a593Smuzhiyun pg_addiu(&buf, A2, A0, off);
304*4882a593Smuzhiyun else
305*4882a593Smuzhiyun uasm_i_ori(&buf, A2, A0, off);
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun if (IS_ENABLED(CONFIG_WAR_R4600_V2_HIT_CACHEOP) && cpu_is_r4600_v2_x())
308*4882a593Smuzhiyun uasm_i_lui(&buf, AT, uasm_rel_hi(0xa0000000));
309*4882a593Smuzhiyun
310*4882a593Smuzhiyun off = cache_line_size ? min(8, pref_bias_clear_store / cache_line_size)
311*4882a593Smuzhiyun * cache_line_size : 0;
312*4882a593Smuzhiyun while (off) {
313*4882a593Smuzhiyun build_clear_pref(&buf, -off);
314*4882a593Smuzhiyun off -= cache_line_size;
315*4882a593Smuzhiyun }
316*4882a593Smuzhiyun uasm_l_clear_pref(&l, buf);
317*4882a593Smuzhiyun do {
318*4882a593Smuzhiyun build_clear_pref(&buf, off);
319*4882a593Smuzhiyun build_clear_store(&buf, off);
320*4882a593Smuzhiyun off += clear_word_size;
321*4882a593Smuzhiyun } while (off < half_clear_loop_size);
322*4882a593Smuzhiyun pg_addiu(&buf, A0, A0, 2 * off);
323*4882a593Smuzhiyun off = -off;
324*4882a593Smuzhiyun do {
325*4882a593Smuzhiyun build_clear_pref(&buf, off);
326*4882a593Smuzhiyun if (off == -clear_word_size)
327*4882a593Smuzhiyun uasm_il_bne(&buf, &r, A0, A2, label_clear_pref);
328*4882a593Smuzhiyun build_clear_store(&buf, off);
329*4882a593Smuzhiyun off += clear_word_size;
330*4882a593Smuzhiyun } while (off < 0);
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun if (pref_bias_clear_store) {
333*4882a593Smuzhiyun pg_addiu(&buf, A2, A0, pref_bias_clear_store);
334*4882a593Smuzhiyun uasm_l_clear_nopref(&l, buf);
335*4882a593Smuzhiyun off = 0;
336*4882a593Smuzhiyun do {
337*4882a593Smuzhiyun build_clear_store(&buf, off);
338*4882a593Smuzhiyun off += clear_word_size;
339*4882a593Smuzhiyun } while (off < half_clear_loop_size);
340*4882a593Smuzhiyun pg_addiu(&buf, A0, A0, 2 * off);
341*4882a593Smuzhiyun off = -off;
342*4882a593Smuzhiyun do {
343*4882a593Smuzhiyun if (off == -clear_word_size)
344*4882a593Smuzhiyun uasm_il_bne(&buf, &r, A0, A2,
345*4882a593Smuzhiyun label_clear_nopref);
346*4882a593Smuzhiyun build_clear_store(&buf, off);
347*4882a593Smuzhiyun off += clear_word_size;
348*4882a593Smuzhiyun } while (off < 0);
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun
351*4882a593Smuzhiyun uasm_i_jr(&buf, RA);
352*4882a593Smuzhiyun uasm_i_nop(&buf);
353*4882a593Smuzhiyun
354*4882a593Smuzhiyun BUG_ON(buf > &__clear_page_end);
355*4882a593Smuzhiyun
356*4882a593Smuzhiyun uasm_resolve_relocs(relocs, labels);
357*4882a593Smuzhiyun
358*4882a593Smuzhiyun pr_debug("Synthesized clear page handler (%u instructions).\n",
359*4882a593Smuzhiyun (u32)(buf - &__clear_page_start));
360*4882a593Smuzhiyun
361*4882a593Smuzhiyun pr_debug("\t.set push\n");
362*4882a593Smuzhiyun pr_debug("\t.set noreorder\n");
363*4882a593Smuzhiyun for (i = 0; i < (buf - &__clear_page_start); i++)
364*4882a593Smuzhiyun pr_debug("\t.word 0x%08x\n", (&__clear_page_start)[i]);
365*4882a593Smuzhiyun pr_debug("\t.set pop\n");
366*4882a593Smuzhiyun }
367*4882a593Smuzhiyun
build_copy_load(u32 ** buf,int reg,int off)368*4882a593Smuzhiyun static void build_copy_load(u32 **buf, int reg, int off)
369*4882a593Smuzhiyun {
370*4882a593Smuzhiyun if (cpu_has_64bit_gp_regs) {
371*4882a593Smuzhiyun uasm_i_ld(buf, reg, off, A1);
372*4882a593Smuzhiyun } else {
373*4882a593Smuzhiyun uasm_i_lw(buf, reg, off, A1);
374*4882a593Smuzhiyun }
375*4882a593Smuzhiyun }
376*4882a593Smuzhiyun
build_copy_store(u32 ** buf,int reg,int off)377*4882a593Smuzhiyun static void build_copy_store(u32 **buf, int reg, int off)
378*4882a593Smuzhiyun {
379*4882a593Smuzhiyun if (cpu_has_64bit_gp_regs) {
380*4882a593Smuzhiyun uasm_i_sd(buf, reg, off, A0);
381*4882a593Smuzhiyun } else {
382*4882a593Smuzhiyun uasm_i_sw(buf, reg, off, A0);
383*4882a593Smuzhiyun }
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun
build_copy_load_pref(u32 ** buf,int off)386*4882a593Smuzhiyun static inline void build_copy_load_pref(u32 **buf, int off)
387*4882a593Smuzhiyun {
388*4882a593Smuzhiyun if (off & cache_line_mask())
389*4882a593Smuzhiyun return;
390*4882a593Smuzhiyun
391*4882a593Smuzhiyun if (pref_bias_copy_load)
392*4882a593Smuzhiyun _uasm_i_pref(buf, pref_src_mode, pref_bias_copy_load + off, A1);
393*4882a593Smuzhiyun }
394*4882a593Smuzhiyun
build_copy_store_pref(u32 ** buf,int off)395*4882a593Smuzhiyun static inline void build_copy_store_pref(u32 **buf, int off)
396*4882a593Smuzhiyun {
397*4882a593Smuzhiyun if (off & cache_line_mask())
398*4882a593Smuzhiyun return;
399*4882a593Smuzhiyun
400*4882a593Smuzhiyun if (pref_bias_copy_store) {
401*4882a593Smuzhiyun _uasm_i_pref(buf, pref_dst_mode, pref_bias_copy_store + off,
402*4882a593Smuzhiyun A0);
403*4882a593Smuzhiyun } else if (cache_line_size == (half_copy_loop_size << 1)) {
404*4882a593Smuzhiyun if (cpu_has_cache_cdex_s) {
405*4882a593Smuzhiyun uasm_i_cache(buf, Create_Dirty_Excl_SD, off, A0);
406*4882a593Smuzhiyun } else if (cpu_has_cache_cdex_p) {
407*4882a593Smuzhiyun if (IS_ENABLED(CONFIG_WAR_R4600_V1_HIT_CACHEOP) &&
408*4882a593Smuzhiyun cpu_is_r4600_v1_x()) {
409*4882a593Smuzhiyun uasm_i_nop(buf);
410*4882a593Smuzhiyun uasm_i_nop(buf);
411*4882a593Smuzhiyun uasm_i_nop(buf);
412*4882a593Smuzhiyun uasm_i_nop(buf);
413*4882a593Smuzhiyun }
414*4882a593Smuzhiyun
415*4882a593Smuzhiyun if (IS_ENABLED(CONFIG_WAR_R4600_V2_HIT_CACHEOP) &&
416*4882a593Smuzhiyun cpu_is_r4600_v2_x())
417*4882a593Smuzhiyun uasm_i_lw(buf, ZERO, ZERO, AT);
418*4882a593Smuzhiyun
419*4882a593Smuzhiyun uasm_i_cache(buf, Create_Dirty_Excl_D, off, A0);
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun }
423*4882a593Smuzhiyun
build_copy_page(void)424*4882a593Smuzhiyun void build_copy_page(void)
425*4882a593Smuzhiyun {
426*4882a593Smuzhiyun int off;
427*4882a593Smuzhiyun u32 *buf = &__copy_page_start;
428*4882a593Smuzhiyun struct uasm_label *l = labels;
429*4882a593Smuzhiyun struct uasm_reloc *r = relocs;
430*4882a593Smuzhiyun int i;
431*4882a593Smuzhiyun static atomic_t run_once = ATOMIC_INIT(0);
432*4882a593Smuzhiyun
433*4882a593Smuzhiyun if (atomic_xchg(&run_once, 1)) {
434*4882a593Smuzhiyun return;
435*4882a593Smuzhiyun }
436*4882a593Smuzhiyun
437*4882a593Smuzhiyun memset(labels, 0, sizeof(labels));
438*4882a593Smuzhiyun memset(relocs, 0, sizeof(relocs));
439*4882a593Smuzhiyun
440*4882a593Smuzhiyun set_prefetch_parameters();
441*4882a593Smuzhiyun
442*4882a593Smuzhiyun /*
443*4882a593Smuzhiyun * This algorithm makes the following assumptions:
444*4882a593Smuzhiyun * - All prefetch biases are multiples of 8 words.
445*4882a593Smuzhiyun * - The prefetch biases are less than one page.
446*4882a593Smuzhiyun * - The store prefetch bias isn't greater than the load
447*4882a593Smuzhiyun * prefetch bias.
448*4882a593Smuzhiyun */
449*4882a593Smuzhiyun BUG_ON(pref_bias_copy_load % (8 * copy_word_size));
450*4882a593Smuzhiyun BUG_ON(pref_bias_copy_store % (8 * copy_word_size));
451*4882a593Smuzhiyun BUG_ON(PAGE_SIZE < pref_bias_copy_load);
452*4882a593Smuzhiyun BUG_ON(pref_bias_copy_store > pref_bias_copy_load);
453*4882a593Smuzhiyun
454*4882a593Smuzhiyun off = PAGE_SIZE - pref_bias_copy_load;
455*4882a593Smuzhiyun if (off > 0xffff || !pref_bias_copy_load)
456*4882a593Smuzhiyun pg_addiu(&buf, A2, A0, off);
457*4882a593Smuzhiyun else
458*4882a593Smuzhiyun uasm_i_ori(&buf, A2, A0, off);
459*4882a593Smuzhiyun
460*4882a593Smuzhiyun if (IS_ENABLED(CONFIG_WAR_R4600_V2_HIT_CACHEOP) && cpu_is_r4600_v2_x())
461*4882a593Smuzhiyun uasm_i_lui(&buf, AT, uasm_rel_hi(0xa0000000));
462*4882a593Smuzhiyun
463*4882a593Smuzhiyun off = cache_line_size ? min(8, pref_bias_copy_load / cache_line_size) *
464*4882a593Smuzhiyun cache_line_size : 0;
465*4882a593Smuzhiyun while (off) {
466*4882a593Smuzhiyun build_copy_load_pref(&buf, -off);
467*4882a593Smuzhiyun off -= cache_line_size;
468*4882a593Smuzhiyun }
469*4882a593Smuzhiyun off = cache_line_size ? min(8, pref_bias_copy_store / cache_line_size) *
470*4882a593Smuzhiyun cache_line_size : 0;
471*4882a593Smuzhiyun while (off) {
472*4882a593Smuzhiyun build_copy_store_pref(&buf, -off);
473*4882a593Smuzhiyun off -= cache_line_size;
474*4882a593Smuzhiyun }
475*4882a593Smuzhiyun uasm_l_copy_pref_both(&l, buf);
476*4882a593Smuzhiyun do {
477*4882a593Smuzhiyun build_copy_load_pref(&buf, off);
478*4882a593Smuzhiyun build_copy_load(&buf, T0, off);
479*4882a593Smuzhiyun build_copy_load_pref(&buf, off + copy_word_size);
480*4882a593Smuzhiyun build_copy_load(&buf, T1, off + copy_word_size);
481*4882a593Smuzhiyun build_copy_load_pref(&buf, off + 2 * copy_word_size);
482*4882a593Smuzhiyun build_copy_load(&buf, T2, off + 2 * copy_word_size);
483*4882a593Smuzhiyun build_copy_load_pref(&buf, off + 3 * copy_word_size);
484*4882a593Smuzhiyun build_copy_load(&buf, T3, off + 3 * copy_word_size);
485*4882a593Smuzhiyun build_copy_store_pref(&buf, off);
486*4882a593Smuzhiyun build_copy_store(&buf, T0, off);
487*4882a593Smuzhiyun build_copy_store_pref(&buf, off + copy_word_size);
488*4882a593Smuzhiyun build_copy_store(&buf, T1, off + copy_word_size);
489*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 2 * copy_word_size);
490*4882a593Smuzhiyun build_copy_store(&buf, T2, off + 2 * copy_word_size);
491*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 3 * copy_word_size);
492*4882a593Smuzhiyun build_copy_store(&buf, T3, off + 3 * copy_word_size);
493*4882a593Smuzhiyun off += 4 * copy_word_size;
494*4882a593Smuzhiyun } while (off < half_copy_loop_size);
495*4882a593Smuzhiyun pg_addiu(&buf, A1, A1, 2 * off);
496*4882a593Smuzhiyun pg_addiu(&buf, A0, A0, 2 * off);
497*4882a593Smuzhiyun off = -off;
498*4882a593Smuzhiyun do {
499*4882a593Smuzhiyun build_copy_load_pref(&buf, off);
500*4882a593Smuzhiyun build_copy_load(&buf, T0, off);
501*4882a593Smuzhiyun build_copy_load_pref(&buf, off + copy_word_size);
502*4882a593Smuzhiyun build_copy_load(&buf, T1, off + copy_word_size);
503*4882a593Smuzhiyun build_copy_load_pref(&buf, off + 2 * copy_word_size);
504*4882a593Smuzhiyun build_copy_load(&buf, T2, off + 2 * copy_word_size);
505*4882a593Smuzhiyun build_copy_load_pref(&buf, off + 3 * copy_word_size);
506*4882a593Smuzhiyun build_copy_load(&buf, T3, off + 3 * copy_word_size);
507*4882a593Smuzhiyun build_copy_store_pref(&buf, off);
508*4882a593Smuzhiyun build_copy_store(&buf, T0, off);
509*4882a593Smuzhiyun build_copy_store_pref(&buf, off + copy_word_size);
510*4882a593Smuzhiyun build_copy_store(&buf, T1, off + copy_word_size);
511*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 2 * copy_word_size);
512*4882a593Smuzhiyun build_copy_store(&buf, T2, off + 2 * copy_word_size);
513*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 3 * copy_word_size);
514*4882a593Smuzhiyun if (off == -(4 * copy_word_size))
515*4882a593Smuzhiyun uasm_il_bne(&buf, &r, A2, A0, label_copy_pref_both);
516*4882a593Smuzhiyun build_copy_store(&buf, T3, off + 3 * copy_word_size);
517*4882a593Smuzhiyun off += 4 * copy_word_size;
518*4882a593Smuzhiyun } while (off < 0);
519*4882a593Smuzhiyun
520*4882a593Smuzhiyun if (pref_bias_copy_load - pref_bias_copy_store) {
521*4882a593Smuzhiyun pg_addiu(&buf, A2, A0,
522*4882a593Smuzhiyun pref_bias_copy_load - pref_bias_copy_store);
523*4882a593Smuzhiyun uasm_l_copy_pref_store(&l, buf);
524*4882a593Smuzhiyun off = 0;
525*4882a593Smuzhiyun do {
526*4882a593Smuzhiyun build_copy_load(&buf, T0, off);
527*4882a593Smuzhiyun build_copy_load(&buf, T1, off + copy_word_size);
528*4882a593Smuzhiyun build_copy_load(&buf, T2, off + 2 * copy_word_size);
529*4882a593Smuzhiyun build_copy_load(&buf, T3, off + 3 * copy_word_size);
530*4882a593Smuzhiyun build_copy_store_pref(&buf, off);
531*4882a593Smuzhiyun build_copy_store(&buf, T0, off);
532*4882a593Smuzhiyun build_copy_store_pref(&buf, off + copy_word_size);
533*4882a593Smuzhiyun build_copy_store(&buf, T1, off + copy_word_size);
534*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 2 * copy_word_size);
535*4882a593Smuzhiyun build_copy_store(&buf, T2, off + 2 * copy_word_size);
536*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 3 * copy_word_size);
537*4882a593Smuzhiyun build_copy_store(&buf, T3, off + 3 * copy_word_size);
538*4882a593Smuzhiyun off += 4 * copy_word_size;
539*4882a593Smuzhiyun } while (off < half_copy_loop_size);
540*4882a593Smuzhiyun pg_addiu(&buf, A1, A1, 2 * off);
541*4882a593Smuzhiyun pg_addiu(&buf, A0, A0, 2 * off);
542*4882a593Smuzhiyun off = -off;
543*4882a593Smuzhiyun do {
544*4882a593Smuzhiyun build_copy_load(&buf, T0, off);
545*4882a593Smuzhiyun build_copy_load(&buf, T1, off + copy_word_size);
546*4882a593Smuzhiyun build_copy_load(&buf, T2, off + 2 * copy_word_size);
547*4882a593Smuzhiyun build_copy_load(&buf, T3, off + 3 * copy_word_size);
548*4882a593Smuzhiyun build_copy_store_pref(&buf, off);
549*4882a593Smuzhiyun build_copy_store(&buf, T0, off);
550*4882a593Smuzhiyun build_copy_store_pref(&buf, off + copy_word_size);
551*4882a593Smuzhiyun build_copy_store(&buf, T1, off + copy_word_size);
552*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 2 * copy_word_size);
553*4882a593Smuzhiyun build_copy_store(&buf, T2, off + 2 * copy_word_size);
554*4882a593Smuzhiyun build_copy_store_pref(&buf, off + 3 * copy_word_size);
555*4882a593Smuzhiyun if (off == -(4 * copy_word_size))
556*4882a593Smuzhiyun uasm_il_bne(&buf, &r, A2, A0,
557*4882a593Smuzhiyun label_copy_pref_store);
558*4882a593Smuzhiyun build_copy_store(&buf, T3, off + 3 * copy_word_size);
559*4882a593Smuzhiyun off += 4 * copy_word_size;
560*4882a593Smuzhiyun } while (off < 0);
561*4882a593Smuzhiyun }
562*4882a593Smuzhiyun
563*4882a593Smuzhiyun if (pref_bias_copy_store) {
564*4882a593Smuzhiyun pg_addiu(&buf, A2, A0, pref_bias_copy_store);
565*4882a593Smuzhiyun uasm_l_copy_nopref(&l, buf);
566*4882a593Smuzhiyun off = 0;
567*4882a593Smuzhiyun do {
568*4882a593Smuzhiyun build_copy_load(&buf, T0, off);
569*4882a593Smuzhiyun build_copy_load(&buf, T1, off + copy_word_size);
570*4882a593Smuzhiyun build_copy_load(&buf, T2, off + 2 * copy_word_size);
571*4882a593Smuzhiyun build_copy_load(&buf, T3, off + 3 * copy_word_size);
572*4882a593Smuzhiyun build_copy_store(&buf, T0, off);
573*4882a593Smuzhiyun build_copy_store(&buf, T1, off + copy_word_size);
574*4882a593Smuzhiyun build_copy_store(&buf, T2, off + 2 * copy_word_size);
575*4882a593Smuzhiyun build_copy_store(&buf, T3, off + 3 * copy_word_size);
576*4882a593Smuzhiyun off += 4 * copy_word_size;
577*4882a593Smuzhiyun } while (off < half_copy_loop_size);
578*4882a593Smuzhiyun pg_addiu(&buf, A1, A1, 2 * off);
579*4882a593Smuzhiyun pg_addiu(&buf, A0, A0, 2 * off);
580*4882a593Smuzhiyun off = -off;
581*4882a593Smuzhiyun do {
582*4882a593Smuzhiyun build_copy_load(&buf, T0, off);
583*4882a593Smuzhiyun build_copy_load(&buf, T1, off + copy_word_size);
584*4882a593Smuzhiyun build_copy_load(&buf, T2, off + 2 * copy_word_size);
585*4882a593Smuzhiyun build_copy_load(&buf, T3, off + 3 * copy_word_size);
586*4882a593Smuzhiyun build_copy_store(&buf, T0, off);
587*4882a593Smuzhiyun build_copy_store(&buf, T1, off + copy_word_size);
588*4882a593Smuzhiyun build_copy_store(&buf, T2, off + 2 * copy_word_size);
589*4882a593Smuzhiyun if (off == -(4 * copy_word_size))
590*4882a593Smuzhiyun uasm_il_bne(&buf, &r, A2, A0,
591*4882a593Smuzhiyun label_copy_nopref);
592*4882a593Smuzhiyun build_copy_store(&buf, T3, off + 3 * copy_word_size);
593*4882a593Smuzhiyun off += 4 * copy_word_size;
594*4882a593Smuzhiyun } while (off < 0);
595*4882a593Smuzhiyun }
596*4882a593Smuzhiyun
597*4882a593Smuzhiyun uasm_i_jr(&buf, RA);
598*4882a593Smuzhiyun uasm_i_nop(&buf);
599*4882a593Smuzhiyun
600*4882a593Smuzhiyun BUG_ON(buf > &__copy_page_end);
601*4882a593Smuzhiyun
602*4882a593Smuzhiyun uasm_resolve_relocs(relocs, labels);
603*4882a593Smuzhiyun
604*4882a593Smuzhiyun pr_debug("Synthesized copy page handler (%u instructions).\n",
605*4882a593Smuzhiyun (u32)(buf - &__copy_page_start));
606*4882a593Smuzhiyun
607*4882a593Smuzhiyun pr_debug("\t.set push\n");
608*4882a593Smuzhiyun pr_debug("\t.set noreorder\n");
609*4882a593Smuzhiyun for (i = 0; i < (buf - &__copy_page_start); i++)
610*4882a593Smuzhiyun pr_debug("\t.word 0x%08x\n", (&__copy_page_start)[i]);
611*4882a593Smuzhiyun pr_debug("\t.set pop\n");
612*4882a593Smuzhiyun }
613*4882a593Smuzhiyun
614*4882a593Smuzhiyun #ifdef CONFIG_SIBYTE_DMA_PAGEOPS
615*4882a593Smuzhiyun extern void clear_page_cpu(void *page);
616*4882a593Smuzhiyun extern void copy_page_cpu(void *to, void *from);
617*4882a593Smuzhiyun
618*4882a593Smuzhiyun /*
619*4882a593Smuzhiyun * Pad descriptors to cacheline, since each is exclusively owned by a
620*4882a593Smuzhiyun * particular CPU.
621*4882a593Smuzhiyun */
622*4882a593Smuzhiyun struct dmadscr {
623*4882a593Smuzhiyun u64 dscr_a;
624*4882a593Smuzhiyun u64 dscr_b;
625*4882a593Smuzhiyun u64 pad_a;
626*4882a593Smuzhiyun u64 pad_b;
627*4882a593Smuzhiyun } ____cacheline_aligned_in_smp page_descr[DM_NUM_CHANNELS];
628*4882a593Smuzhiyun
clear_page(void * page)629*4882a593Smuzhiyun void clear_page(void *page)
630*4882a593Smuzhiyun {
631*4882a593Smuzhiyun u64 to_phys = CPHYSADDR((unsigned long)page);
632*4882a593Smuzhiyun unsigned int cpu = smp_processor_id();
633*4882a593Smuzhiyun
634*4882a593Smuzhiyun /* if the page is not in KSEG0, use old way */
635*4882a593Smuzhiyun if ((long)KSEGX((unsigned long)page) != (long)CKSEG0)
636*4882a593Smuzhiyun return clear_page_cpu(page);
637*4882a593Smuzhiyun
638*4882a593Smuzhiyun page_descr[cpu].dscr_a = to_phys | M_DM_DSCRA_ZERO_MEM |
639*4882a593Smuzhiyun M_DM_DSCRA_L2C_DEST | M_DM_DSCRA_INTERRUPT;
640*4882a593Smuzhiyun page_descr[cpu].dscr_b = V_DM_DSCRB_SRC_LENGTH(PAGE_SIZE);
641*4882a593Smuzhiyun __raw_writeq(1, IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_COUNT)));
642*4882a593Smuzhiyun
643*4882a593Smuzhiyun /*
644*4882a593Smuzhiyun * Don't really want to do it this way, but there's no
645*4882a593Smuzhiyun * reliable way to delay completion detection.
646*4882a593Smuzhiyun */
647*4882a593Smuzhiyun while (!(__raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE_DEBUG)))
648*4882a593Smuzhiyun & M_DM_DSCR_BASE_INTERRUPT))
649*4882a593Smuzhiyun ;
650*4882a593Smuzhiyun __raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
651*4882a593Smuzhiyun }
652*4882a593Smuzhiyun EXPORT_SYMBOL(clear_page);
653*4882a593Smuzhiyun
copy_page(void * to,void * from)654*4882a593Smuzhiyun void copy_page(void *to, void *from)
655*4882a593Smuzhiyun {
656*4882a593Smuzhiyun u64 from_phys = CPHYSADDR((unsigned long)from);
657*4882a593Smuzhiyun u64 to_phys = CPHYSADDR((unsigned long)to);
658*4882a593Smuzhiyun unsigned int cpu = smp_processor_id();
659*4882a593Smuzhiyun
660*4882a593Smuzhiyun /* if any page is not in KSEG0, use old way */
661*4882a593Smuzhiyun if ((long)KSEGX((unsigned long)to) != (long)CKSEG0
662*4882a593Smuzhiyun || (long)KSEGX((unsigned long)from) != (long)CKSEG0)
663*4882a593Smuzhiyun return copy_page_cpu(to, from);
664*4882a593Smuzhiyun
665*4882a593Smuzhiyun page_descr[cpu].dscr_a = to_phys | M_DM_DSCRA_L2C_DEST |
666*4882a593Smuzhiyun M_DM_DSCRA_INTERRUPT;
667*4882a593Smuzhiyun page_descr[cpu].dscr_b = from_phys | V_DM_DSCRB_SRC_LENGTH(PAGE_SIZE);
668*4882a593Smuzhiyun __raw_writeq(1, IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_COUNT)));
669*4882a593Smuzhiyun
670*4882a593Smuzhiyun /*
671*4882a593Smuzhiyun * Don't really want to do it this way, but there's no
672*4882a593Smuzhiyun * reliable way to delay completion detection.
673*4882a593Smuzhiyun */
674*4882a593Smuzhiyun while (!(__raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE_DEBUG)))
675*4882a593Smuzhiyun & M_DM_DSCR_BASE_INTERRUPT))
676*4882a593Smuzhiyun ;
677*4882a593Smuzhiyun __raw_readq(IOADDR(A_DM_REGISTER(cpu, R_DM_DSCR_BASE)));
678*4882a593Smuzhiyun }
679*4882a593Smuzhiyun EXPORT_SYMBOL(copy_page);
680*4882a593Smuzhiyun
681*4882a593Smuzhiyun #endif /* CONFIG_SIBYTE_DMA_PAGEOPS */
682