1/*
2 * viking.S: High speed Viking cache/mmu operations
3 *
4 * Copyright (C) 1997  Eddie C. Dost  (ecd@skynet.be)
5 * Copyright (C) 1997,1998,1999  Jakub Jelinek  (jj@ultra.linux.cz)
6 * Copyright (C) 1999  Pavel Semerad  (semerad@ss1000.ms.mff.cuni.cz)
7 */
8
9#include <asm/ptrace.h>
10#include <asm/psr.h>
11#include <asm/asm-offsets.h>
12#include <asm/asi.h>
13#include <asm/mxcc.h>
14#include <asm/page.h>
15#include <asm/pgtsrmmu.h>
16#include <asm/viking.h>
17
18#ifdef CONFIG_SMP
19	.data
20	.align	4
21sun4dsmp_flush_tlb_spin:
22	.word	0
23#endif
24
25	.text
26	.align	4
27
28	.globl	viking_flush_cache_all, viking_flush_cache_mm
29	.globl	viking_flush_cache_range, viking_flush_cache_page
30	.globl	viking_flush_page, viking_mxcc_flush_page
31	.globl	viking_flush_page_for_dma, viking_flush_page_to_ram
32	.globl	viking_flush_sig_insns
33	.globl	viking_flush_tlb_all, viking_flush_tlb_mm
34	.globl	viking_flush_tlb_range, viking_flush_tlb_page
35
36viking_flush_page:
37	sethi	%hi(PAGE_OFFSET), %g2
38	sub	%o0, %g2, %g3
39	srl	%g3, 12, %g1		! ppage >> 12
40
41	clr	%o1			! set counter, 0 - 127
42	sethi	%hi(PAGE_OFFSET + PAGE_SIZE - 0x80000000), %o3
43	sethi	%hi(0x80000000), %o4
44	sethi	%hi(VIKING_PTAG_VALID), %o5
45	sethi	%hi(2*PAGE_SIZE), %o0
46	sethi	%hi(PAGE_SIZE), %g7
47	clr	%o2			! block counter, 0 - 3
485:
49	sll	%o1, 5, %g4
50	or	%g4, %o4, %g4		! 0x80000000 | (set << 5)
51
52	sll	%o2, 26, %g5		! block << 26
536:
54	or	%g5, %g4, %g5
55	ldda	[%g5] ASI_M_DATAC_TAG, %g2
56	cmp	%g3, %g1		! ptag == ppage?
57	bne	7f
58	 inc	%o2
59
60	andcc	%g2, %o5, %g0		! ptag VALID?
61	be	7f
62	 add	%g4, %o3, %g2		! (PAGE_OFFSET + PAGE_SIZE) | (set << 5)
63	ld	[%g2], %g3
64	ld	[%g2 + %g7], %g3
65	add	%g2, %o0, %g2
66	ld	[%g2], %g3
67	ld	[%g2 + %g7], %g3
68	add	%g2, %o0, %g2
69	ld	[%g2], %g3
70	ld	[%g2 + %g7], %g3
71	add	%g2, %o0, %g2
72	ld	[%g2], %g3
73	b	8f
74	 ld	[%g2 + %g7], %g3
75
767:
77	cmp	%o2, 3
78	ble	6b
79	 sll	%o2, 26, %g5			! block << 26
80
818:	inc	%o1
82	cmp	%o1, 0x7f
83	ble	5b
84	 clr	%o2
85
869:	retl
87	 nop
88
89viking_mxcc_flush_page:
90	sethi	%hi(PAGE_OFFSET), %g2
91	sub	%o0, %g2, %g3
92	sub	%g3, -PAGE_SIZE, %g3		! ppage + PAGE_SIZE
93	sethi	%hi(MXCC_SRCSTREAM), %o3	! assume %hi(MXCC_SRCSTREAM) == %hi(MXCC_DESTSTREAM)
94	mov	0x10, %g2			! set cacheable bit
95	or	%o3, %lo(MXCC_SRCSTREAM), %o2
96	or	%o3, %lo(MXCC_DESSTREAM), %o3
97	sub	%g3, MXCC_STREAM_SIZE, %g3
986:
99	stda	%g2, [%o2] ASI_M_MXCC
100	stda	%g2, [%o3] ASI_M_MXCC
101	andncc	%g3, PAGE_MASK, %g0
102	bne	6b
103	 sub	%g3, MXCC_STREAM_SIZE, %g3
104
1059:	retl
106	 nop
107
108viking_flush_cache_page:
109viking_flush_cache_range:
110#ifndef CONFIG_SMP
111	ld	[%o0 + VMA_VM_MM], %o0
112#endif
113viking_flush_cache_mm:
114#ifndef CONFIG_SMP
115	ld	[%o0 + AOFF_mm_context], %g1
116	cmp	%g1, -1
117	bne	viking_flush_cache_all
118	 nop
119	b,a	viking_flush_cache_out
120#endif
121viking_flush_cache_all:
122	WINDOW_FLUSH(%g4, %g5)
123viking_flush_cache_out:
124	retl
125	 nop
126
127viking_flush_tlb_all:
128	mov	0x400, %g1
129	retl
130	 sta	%g0, [%g1] ASI_M_FLUSH_PROBE
131
132viking_flush_tlb_mm:
133	mov	SRMMU_CTX_REG, %g1
134	ld	[%o0 + AOFF_mm_context], %o1
135	lda	[%g1] ASI_M_MMUREGS, %g5
136#ifndef CONFIG_SMP
137	cmp	%o1, -1
138	be	1f
139#endif
140	mov	0x300, %g2
141	sta	%o1, [%g1] ASI_M_MMUREGS
142	sta	%g0, [%g2] ASI_M_FLUSH_PROBE
143	retl
144	 sta	%g5, [%g1] ASI_M_MMUREGS
145#ifndef CONFIG_SMP
1461:	retl
147	 nop
148#endif
149
150viking_flush_tlb_range:
151	ld	[%o0 + VMA_VM_MM], %o0
152	mov	SRMMU_CTX_REG, %g1
153	ld	[%o0 + AOFF_mm_context], %o3
154	lda	[%g1] ASI_M_MMUREGS, %g5
155#ifndef CONFIG_SMP
156	cmp	%o3, -1
157	be	2f
158#endif
159	sethi	%hi(~((1 << SRMMU_PGDIR_SHIFT) - 1)), %o4
160	sta	%o3, [%g1] ASI_M_MMUREGS
161	and	%o1, %o4, %o1
162	add	%o1, 0x200, %o1
163	sta	%g0, [%o1] ASI_M_FLUSH_PROBE
1641:	sub	%o1, %o4, %o1
165	cmp	%o1, %o2
166	blu,a	1b
167	 sta	%g0, [%o1] ASI_M_FLUSH_PROBE
168	retl
169	 sta	%g5, [%g1] ASI_M_MMUREGS
170#ifndef CONFIG_SMP
1712:	retl
172	 nop
173#endif
174
175viking_flush_tlb_page:
176	ld	[%o0 + VMA_VM_MM], %o0
177	mov	SRMMU_CTX_REG, %g1
178	ld	[%o0 + AOFF_mm_context], %o3
179	lda	[%g1] ASI_M_MMUREGS, %g5
180#ifndef CONFIG_SMP
181	cmp	%o3, -1
182	be	1f
183#endif
184	and	%o1, PAGE_MASK, %o1
185	sta	%o3, [%g1] ASI_M_MMUREGS
186	sta	%g0, [%o1] ASI_M_FLUSH_PROBE
187	retl
188	 sta	%g5, [%g1] ASI_M_MMUREGS
189#ifndef CONFIG_SMP
1901:	retl
191	 nop
192#endif
193
194viking_flush_page_to_ram:
195viking_flush_page_for_dma:
196viking_flush_sig_insns:
197	retl
198	 nop
199
200#ifdef CONFIG_SMP
201	.globl	sun4dsmp_flush_tlb_all, sun4dsmp_flush_tlb_mm
202	.globl	sun4dsmp_flush_tlb_range, sun4dsmp_flush_tlb_page
203sun4dsmp_flush_tlb_all:
204	sethi	%hi(sun4dsmp_flush_tlb_spin), %g3
2051:	ldstub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
206	tst	%g5
207	bne	2f
208	 mov	0x400, %g1
209	sta	%g0, [%g1] ASI_M_FLUSH_PROBE
210	retl
211	 stb	%g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
2122:	tst	%g5
213	bne,a	2b
214	 ldub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
215	b,a	1b
216
217sun4dsmp_flush_tlb_mm:
218	sethi	%hi(sun4dsmp_flush_tlb_spin), %g3
2191:	ldstub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
220	tst	%g5
221	bne	2f
222	 mov	SRMMU_CTX_REG, %g1
223	ld	[%o0 + AOFF_mm_context], %o1
224	lda	[%g1] ASI_M_MMUREGS, %g5
225	mov	0x300, %g2
226	sta	%o1, [%g1] ASI_M_MMUREGS
227	sta	%g0, [%g2] ASI_M_FLUSH_PROBE
228	sta	%g5, [%g1] ASI_M_MMUREGS
229	retl
230	 stb	%g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
2312:	tst	%g5
232	bne,a	2b
233	 ldub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
234	b,a	1b
235
236sun4dsmp_flush_tlb_range:
237	sethi	%hi(sun4dsmp_flush_tlb_spin), %g3
2381:	ldstub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
239	tst	%g5
240	bne	3f
241	 mov	SRMMU_CTX_REG, %g1
242	ld	[%o0 + VMA_VM_MM], %o0
243	ld	[%o0 + AOFF_mm_context], %o3
244	lda	[%g1] ASI_M_MMUREGS, %g5
245	sethi	%hi(~((1 << SRMMU_PGDIR_SHIFT) - 1)), %o4
246	sta	%o3, [%g1] ASI_M_MMUREGS
247	and	%o1, %o4, %o1
248	add	%o1, 0x200, %o1
249	sta	%g0, [%o1] ASI_M_FLUSH_PROBE
2502:	sub	%o1, %o4, %o1
251	cmp	%o1, %o2
252	blu,a	2b
253	 sta	%g0, [%o1] ASI_M_FLUSH_PROBE
254	sta	%g5, [%g1] ASI_M_MMUREGS
255	retl
256	 stb	%g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
2573:	tst	%g5
258	bne,a	3b
259	 ldub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
260	b,a	1b
261
262sun4dsmp_flush_tlb_page:
263	sethi	%hi(sun4dsmp_flush_tlb_spin), %g3
2641:	ldstub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
265	tst	%g5
266	bne	2f
267	 mov	SRMMU_CTX_REG, %g1
268	ld	[%o0 + VMA_VM_MM], %o0
269	ld	[%o0 + AOFF_mm_context], %o3
270	lda	[%g1] ASI_M_MMUREGS, %g5
271	and	%o1, PAGE_MASK, %o1
272	sta	%o3, [%g1] ASI_M_MMUREGS
273	sta	%g0, [%o1] ASI_M_FLUSH_PROBE
274	sta	%g5, [%g1] ASI_M_MMUREGS
275	retl
276	 stb	%g0, [%g3 + %lo(sun4dsmp_flush_tlb_spin)]
2772:	tst	%g5
278	bne,a	2b
279	 ldub	[%g3 + %lo(sun4dsmp_flush_tlb_spin)], %g5
280	b,a	1b
281	 nop
282#endif
283