xref: /openbmc/linux/arch/mips/include/asm/stackframe.h (revision 2a0b24f5)
1 /*
2  * This file is subject to the terms and conditions of the GNU General Public
3  * License.  See the file "COPYING" in the main directory of this archive
4  * for more details.
5  *
6  * Copyright (C) 1994, 95, 96, 99, 2001 Ralf Baechle
7  * Copyright (C) 1994, 1995, 1996 Paul M. Antoine.
8  * Copyright (C) 1999 Silicon Graphics, Inc.
9  * Copyright (C) 2007  Maciej W. Rozycki
10  */
11 #ifndef _ASM_STACKFRAME_H
12 #define _ASM_STACKFRAME_H
13 
14 #include <linux/threads.h>
15 
16 #include <asm/asm.h>
17 #include <asm/asmmacro.h>
18 #include <asm/mipsregs.h>
19 #include <asm/asm-offsets.h>
20 
21 /*
22  * For SMTC kernel, global IE should be left set, and interrupts
23  * controlled exclusively via IXMT.
24  */
25 #ifdef CONFIG_MIPS_MT_SMTC
26 #define STATMASK 0x1e
27 #elif defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
28 #define STATMASK 0x3f
29 #else
30 #define STATMASK 0x1f
31 #endif
32 
33 #ifdef CONFIG_MIPS_MT_SMTC
34 #include <asm/mipsmtregs.h>
35 #endif /* CONFIG_MIPS_MT_SMTC */
36 
37 		.macro	SAVE_AT
38 		.set	push
39 		.set	noat
40 		LONG_S	$1, PT_R1(sp)
41 		.set	pop
42 		.endm
43 
44 		.macro	SAVE_TEMP
45 #ifdef CONFIG_CPU_HAS_SMARTMIPS
46 		mflhxu	v1
47 		LONG_S	v1, PT_LO(sp)
48 		mflhxu	v1
49 		LONG_S	v1, PT_HI(sp)
50 		mflhxu	v1
51 		LONG_S	v1, PT_ACX(sp)
52 #else
53 		mfhi	v1
54 #endif
55 #ifdef CONFIG_32BIT
56 		LONG_S	$8, PT_R8(sp)
57 		LONG_S	$9, PT_R9(sp)
58 #endif
59 		LONG_S	$10, PT_R10(sp)
60 		LONG_S	$11, PT_R11(sp)
61 		LONG_S	$12, PT_R12(sp)
62 #ifndef CONFIG_CPU_HAS_SMARTMIPS
63 		LONG_S	v1, PT_HI(sp)
64 		mflo	v1
65 #endif
66 		LONG_S	$13, PT_R13(sp)
67 		LONG_S	$14, PT_R14(sp)
68 		LONG_S	$15, PT_R15(sp)
69 		LONG_S	$24, PT_R24(sp)
70 #ifndef CONFIG_CPU_HAS_SMARTMIPS
71 		LONG_S	v1, PT_LO(sp)
72 #endif
73 		.endm
74 
75 		.macro	SAVE_STATIC
76 		LONG_S	$16, PT_R16(sp)
77 		LONG_S	$17, PT_R17(sp)
78 		LONG_S	$18, PT_R18(sp)
79 		LONG_S	$19, PT_R19(sp)
80 		LONG_S	$20, PT_R20(sp)
81 		LONG_S	$21, PT_R21(sp)
82 		LONG_S	$22, PT_R22(sp)
83 		LONG_S	$23, PT_R23(sp)
84 		LONG_S	$30, PT_R30(sp)
85 		.endm
86 
87 #ifdef CONFIG_SMP
88 #ifdef CONFIG_MIPS_MT_SMTC
89 #define PTEBASE_SHIFT	19	/* TCBIND */
90 #define CPU_ID_REG CP0_TCBIND
91 #define CPU_ID_MFC0 mfc0
92 #elif defined(CONFIG_MIPS_PGD_C0_CONTEXT)
93 #define PTEBASE_SHIFT	48	/* XCONTEXT */
94 #define CPU_ID_REG CP0_XCONTEXT
95 #define CPU_ID_MFC0 MFC0
96 #else
97 #define PTEBASE_SHIFT	23	/* CONTEXT */
98 #define CPU_ID_REG CP0_CONTEXT
99 #define CPU_ID_MFC0 MFC0
100 #endif
101 		.macro	get_saved_sp	/* SMP variation */
102 		CPU_ID_MFC0	k0, CPU_ID_REG
103 #if defined(CONFIG_32BIT) || defined(KBUILD_64BIT_SYM32)
104 		lui	k1, %hi(kernelsp)
105 #else
106 		lui	k1, %highest(kernelsp)
107 		daddiu	k1, %higher(kernelsp)
108 		dsll	k1, 16
109 		daddiu	k1, %hi(kernelsp)
110 		dsll	k1, 16
111 #endif
112 		LONG_SRL	k0, PTEBASE_SHIFT
113 		LONG_ADDU	k1, k0
114 		LONG_L	k1, %lo(kernelsp)(k1)
115 		.endm
116 
117 		.macro	set_saved_sp stackp temp temp2
118 		CPU_ID_MFC0	\temp, CPU_ID_REG
119 		LONG_SRL	\temp, PTEBASE_SHIFT
120 		LONG_S	\stackp, kernelsp(\temp)
121 		.endm
122 #else
123 		.macro	get_saved_sp	/* Uniprocessor variation */
124 #ifdef CONFIG_CPU_JUMP_WORKAROUNDS
125 		/*
126 		 * Clear BTB (branch target buffer), forbid RAS (return address
127 		 * stack) to workaround the Out-of-order Issue in Loongson2F
128 		 * via its diagnostic register.
129 		 */
130 		move	k0, ra
131 		jal	1f
132 		 nop
133 1:		jal	1f
134 		 nop
135 1:		jal	1f
136 		 nop
137 1:		jal	1f
138 		 nop
139 1:		move	ra, k0
140 		li	k0, 3
141 		mtc0	k0, $22
142 #endif /* CONFIG_CPU_JUMP_WORKAROUNDS */
143 #if defined(CONFIG_32BIT) || defined(KBUILD_64BIT_SYM32)
144 		lui	k1, %hi(kernelsp)
145 #else
146 		lui	k1, %highest(kernelsp)
147 		daddiu	k1, %higher(kernelsp)
148 		dsll	k1, k1, 16
149 		daddiu	k1, %hi(kernelsp)
150 		dsll	k1, k1, 16
151 #endif
152 		LONG_L	k1, %lo(kernelsp)(k1)
153 		.endm
154 
155 		.macro	set_saved_sp stackp temp temp2
156 		LONG_S	\stackp, kernelsp
157 		.endm
158 #endif
159 
160 		.macro	SAVE_SOME
161 		.set	push
162 		.set	noat
163 		.set	reorder
164 		mfc0	k0, CP0_STATUS
165 		sll	k0, 3		/* extract cu0 bit */
166 		.set	noreorder
167 		bltz	k0, 8f
168 		 move	k1, sp
169 		.set	reorder
170 		/* Called from user mode, new stack. */
171 		get_saved_sp
172 #ifndef CONFIG_CPU_DADDI_WORKAROUNDS
173 8:		move	k0, sp
174 		PTR_SUBU sp, k1, PT_SIZE
175 #else
176 		.set	at=k0
177 8:		PTR_SUBU k1, PT_SIZE
178 		.set	noat
179 		move	k0, sp
180 		move	sp, k1
181 #endif
182 		LONG_S	k0, PT_R29(sp)
183 		LONG_S	$3, PT_R3(sp)
184 		/*
185 		 * You might think that you don't need to save $0,
186 		 * but the FPU emulator and gdb remote debug stub
187 		 * need it to operate correctly
188 		 */
189 		LONG_S	$0, PT_R0(sp)
190 		mfc0	v1, CP0_STATUS
191 		LONG_S	$2, PT_R2(sp)
192 		LONG_S	v1, PT_STATUS(sp)
193 #ifdef CONFIG_MIPS_MT_SMTC
194 		/*
195 		 * Ideally, these instructions would be shuffled in
196 		 * to cover the pipeline delay.
197 		 */
198 		.set	mips32
199 		mfc0	k0, CP0_TCSTATUS
200 		.set	mips0
201 		LONG_S	k0, PT_TCSTATUS(sp)
202 #endif /* CONFIG_MIPS_MT_SMTC */
203 		LONG_S	$4, PT_R4(sp)
204 		mfc0	v1, CP0_CAUSE
205 		LONG_S	$5, PT_R5(sp)
206 		LONG_S	v1, PT_CAUSE(sp)
207 		LONG_S	$6, PT_R6(sp)
208 		MFC0	v1, CP0_EPC
209 		LONG_S	$7, PT_R7(sp)
210 #ifdef CONFIG_64BIT
211 		LONG_S	$8, PT_R8(sp)
212 		LONG_S	$9, PT_R9(sp)
213 #endif
214 		LONG_S	v1, PT_EPC(sp)
215 		LONG_S	$25, PT_R25(sp)
216 		LONG_S	$28, PT_R28(sp)
217 		LONG_S	$31, PT_R31(sp)
218 		ori	$28, sp, _THREAD_MASK
219 		xori	$28, _THREAD_MASK
220 #ifdef CONFIG_CPU_CAVIUM_OCTEON
221 		.set	mips64
222 		pref	0, 0($28)	/* Prefetch the current pointer */
223 		pref	0, PT_R31(sp)	/* Prefetch the $31(ra) */
224 		/* The Octeon multiplier state is affected by general multiply
225 		    instructions. It must be saved before and kernel code might
226 		    corrupt it */
227 		jal	octeon_mult_save
228 		LONG_L	v1, 0($28)  /* Load the current pointer */
229 			 /* Restore $31(ra) that was changed by the jal */
230 		LONG_L	ra, PT_R31(sp)
231 		pref	0, 0(v1)    /* Prefetch the current thread */
232 #endif
233 		.set	pop
234 		.endm
235 
236 		.macro	SAVE_ALL
237 		SAVE_SOME
238 		SAVE_AT
239 		SAVE_TEMP
240 		SAVE_STATIC
241 		.endm
242 
243 		.macro	RESTORE_AT
244 		.set	push
245 		.set	noat
246 		LONG_L	$1,  PT_R1(sp)
247 		.set	pop
248 		.endm
249 
250 		.macro	RESTORE_TEMP
251 #ifdef CONFIG_CPU_HAS_SMARTMIPS
252 		LONG_L	$24, PT_ACX(sp)
253 		mtlhx	$24
254 		LONG_L	$24, PT_HI(sp)
255 		mtlhx	$24
256 		LONG_L	$24, PT_LO(sp)
257 		mtlhx	$24
258 #else
259 		LONG_L	$24, PT_LO(sp)
260 		mtlo	$24
261 		LONG_L	$24, PT_HI(sp)
262 		mthi	$24
263 #endif
264 #ifdef CONFIG_32BIT
265 		LONG_L	$8, PT_R8(sp)
266 		LONG_L	$9, PT_R9(sp)
267 #endif
268 		LONG_L	$10, PT_R10(sp)
269 		LONG_L	$11, PT_R11(sp)
270 		LONG_L	$12, PT_R12(sp)
271 		LONG_L	$13, PT_R13(sp)
272 		LONG_L	$14, PT_R14(sp)
273 		LONG_L	$15, PT_R15(sp)
274 		LONG_L	$24, PT_R24(sp)
275 		.endm
276 
277 		.macro	RESTORE_STATIC
278 		LONG_L	$16, PT_R16(sp)
279 		LONG_L	$17, PT_R17(sp)
280 		LONG_L	$18, PT_R18(sp)
281 		LONG_L	$19, PT_R19(sp)
282 		LONG_L	$20, PT_R20(sp)
283 		LONG_L	$21, PT_R21(sp)
284 		LONG_L	$22, PT_R22(sp)
285 		LONG_L	$23, PT_R23(sp)
286 		LONG_L	$30, PT_R30(sp)
287 		.endm
288 
289 #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
290 
291 		.macro	RESTORE_SOME
292 		.set	push
293 		.set	reorder
294 		.set	noat
295 		mfc0	a0, CP0_STATUS
296 		li	v1, 0xff00
297 		ori	a0, STATMASK
298 		xori	a0, STATMASK
299 		mtc0	a0, CP0_STATUS
300 		and	a0, v1
301 		LONG_L	v0, PT_STATUS(sp)
302 		nor	v1, $0, v1
303 		and	v0, v1
304 		or	v0, a0
305 		mtc0	v0, CP0_STATUS
306 		LONG_L	$31, PT_R31(sp)
307 		LONG_L	$28, PT_R28(sp)
308 		LONG_L	$25, PT_R25(sp)
309 		LONG_L	$7,  PT_R7(sp)
310 		LONG_L	$6,  PT_R6(sp)
311 		LONG_L	$5,  PT_R5(sp)
312 		LONG_L	$4,  PT_R4(sp)
313 		LONG_L	$3,  PT_R3(sp)
314 		LONG_L	$2,  PT_R2(sp)
315 		.set	pop
316 		.endm
317 
318 		.macro	RESTORE_SP_AND_RET
319 		.set	push
320 		.set	noreorder
321 		LONG_L	k0, PT_EPC(sp)
322 		LONG_L	sp, PT_R29(sp)
323 		jr	k0
324 		 rfe
325 		.set	pop
326 		.endm
327 
328 #else
329 		.macro	RESTORE_SOME
330 		.set	push
331 		.set	reorder
332 		.set	noat
333 #ifdef CONFIG_MIPS_MT_SMTC
334 		.set	mips32r2
335 		/*
336 		 * We need to make sure the read-modify-write
337 		 * of Status below isn't perturbed by an interrupt
338 		 * or cross-TC access, so we need to do at least a DMT,
339 		 * protected by an interrupt-inhibit. But setting IXMT
340 		 * also creates a few-cycle window where an IPI could
341 		 * be queued and not be detected before potentially
342 		 * returning to a WAIT or user-mode loop. It must be
343 		 * replayed.
344 		 *
345 		 * We're in the middle of a context switch, and
346 		 * we can't dispatch it directly without trashing
347 		 * some registers, so we'll try to detect this unlikely
348 		 * case and program a software interrupt in the VPE,
349 		 * as would be done for a cross-VPE IPI.  To accommodate
350 		 * the handling of that case, we're doing a DVPE instead
351 		 * of just a DMT here to protect against other threads.
352 		 * This is a lot of cruft to cover a tiny window.
353 		 * If you can find a better design, implement it!
354 		 *
355 		 */
356 		mfc0	v0, CP0_TCSTATUS
357 		ori	v0, TCSTATUS_IXMT
358 		mtc0	v0, CP0_TCSTATUS
359 		_ehb
360 		DVPE	5				# dvpe a1
361 		jal	mips_ihb
362 #endif /* CONFIG_MIPS_MT_SMTC */
363 #ifdef CONFIG_CPU_CAVIUM_OCTEON
364 		/* Restore the Octeon multiplier state */
365 		jal	octeon_mult_restore
366 #endif
367 		mfc0	a0, CP0_STATUS
368 		ori	a0, STATMASK
369 		xori	a0, STATMASK
370 		mtc0	a0, CP0_STATUS
371 		li	v1, 0xff00
372 		and	a0, v1
373 		LONG_L	v0, PT_STATUS(sp)
374 		nor	v1, $0, v1
375 		and	v0, v1
376 		or	v0, a0
377 		mtc0	v0, CP0_STATUS
378 #ifdef CONFIG_MIPS_MT_SMTC
379 /*
380  * Only after EXL/ERL have been restored to status can we
381  * restore TCStatus.IXMT.
382  */
383 		LONG_L	v1, PT_TCSTATUS(sp)
384 		_ehb
385 		mfc0	a0, CP0_TCSTATUS
386 		andi	v1, TCSTATUS_IXMT
387 		bnez	v1, 0f
388 
389 /*
390  * We'd like to detect any IPIs queued in the tiny window
391  * above and request an software interrupt to service them
392  * when we ERET.
393  *
394  * Computing the offset into the IPIQ array of the executing
395  * TC's IPI queue in-line would be tedious.  We use part of
396  * the TCContext register to hold 16 bits of offset that we
397  * can add in-line to find the queue head.
398  */
399 		mfc0	v0, CP0_TCCONTEXT
400 		la	a2, IPIQ
401 		srl	v0, v0, 16
402 		addu	a2, a2, v0
403 		LONG_L	v0, 0(a2)
404 		beqz	v0, 0f
405 /*
406  * If we have a queue, provoke dispatch within the VPE by setting C_SW1
407  */
408 		mfc0	v0, CP0_CAUSE
409 		ori	v0, v0, C_SW1
410 		mtc0	v0, CP0_CAUSE
411 0:
412 		/*
413 		 * This test should really never branch but
414 		 * let's be prudent here.  Having atomized
415 		 * the shared register modifications, we can
416 		 * now EVPE, and must do so before interrupts
417 		 * are potentially re-enabled.
418 		 */
419 		andi	a1, a1, MVPCONTROL_EVP
420 		beqz	a1, 1f
421 		evpe
422 1:
423 		/* We know that TCStatua.IXMT should be set from above */
424 		xori	a0, a0, TCSTATUS_IXMT
425 		or	a0, a0, v1
426 		mtc0	a0, CP0_TCSTATUS
427 		_ehb
428 
429 		.set	mips0
430 #endif /* CONFIG_MIPS_MT_SMTC */
431 		LONG_L	v1, PT_EPC(sp)
432 		MTC0	v1, CP0_EPC
433 		LONG_L	$31, PT_R31(sp)
434 		LONG_L	$28, PT_R28(sp)
435 		LONG_L	$25, PT_R25(sp)
436 #ifdef CONFIG_64BIT
437 		LONG_L	$8, PT_R8(sp)
438 		LONG_L	$9, PT_R9(sp)
439 #endif
440 		LONG_L	$7,  PT_R7(sp)
441 		LONG_L	$6,  PT_R6(sp)
442 		LONG_L	$5,  PT_R5(sp)
443 		LONG_L	$4,  PT_R4(sp)
444 		LONG_L	$3,  PT_R3(sp)
445 		LONG_L	$2,  PT_R2(sp)
446 		.set	pop
447 		.endm
448 
449 		.macro	RESTORE_SP_AND_RET
450 		LONG_L	sp, PT_R29(sp)
451 		.set	mips3
452 		eret
453 		.set	mips0
454 		.endm
455 
456 #endif
457 
458 		.macro	RESTORE_SP
459 		LONG_L	sp, PT_R29(sp)
460 		.endm
461 
462 		.macro	RESTORE_ALL
463 		RESTORE_TEMP
464 		RESTORE_STATIC
465 		RESTORE_AT
466 		RESTORE_SOME
467 		RESTORE_SP
468 		.endm
469 
470 		.macro	RESTORE_ALL_AND_RET
471 		RESTORE_TEMP
472 		RESTORE_STATIC
473 		RESTORE_AT
474 		RESTORE_SOME
475 		RESTORE_SP_AND_RET
476 		.endm
477 
478 /*
479  * Move to kernel mode and disable interrupts.
480  * Set cp0 enable bit as sign that we're running on the kernel stack
481  */
482 		.macro	CLI
483 #if !defined(CONFIG_MIPS_MT_SMTC)
484 		mfc0	t0, CP0_STATUS
485 		li	t1, ST0_CU0 | STATMASK
486 		or	t0, t1
487 		xori	t0, STATMASK
488 		mtc0	t0, CP0_STATUS
489 #else /* CONFIG_MIPS_MT_SMTC */
490 		/*
491 		 * For SMTC, we need to set privilege
492 		 * and disable interrupts only for the
493 		 * current TC, using the TCStatus register.
494 		 */
495 		mfc0	t0, CP0_TCSTATUS
496 		/* Fortunately CU 0 is in the same place in both registers */
497 		/* Set TCU0, TMX, TKSU (for later inversion) and IXMT */
498 		li	t1, ST0_CU0 | 0x08001c00
499 		or	t0, t1
500 		/* Clear TKSU, leave IXMT */
501 		xori	t0, 0x00001800
502 		mtc0	t0, CP0_TCSTATUS
503 		_ehb
504 		/* We need to leave the global IE bit set, but clear EXL...*/
505 		mfc0	t0, CP0_STATUS
506 		ori	t0, ST0_EXL | ST0_ERL
507 		xori	t0, ST0_EXL | ST0_ERL
508 		mtc0	t0, CP0_STATUS
509 #endif /* CONFIG_MIPS_MT_SMTC */
510 		irq_disable_hazard
511 		.endm
512 
513 /*
514  * Move to kernel mode and enable interrupts.
515  * Set cp0 enable bit as sign that we're running on the kernel stack
516  */
517 		.macro	STI
518 #if !defined(CONFIG_MIPS_MT_SMTC)
519 		mfc0	t0, CP0_STATUS
520 		li	t1, ST0_CU0 | STATMASK
521 		or	t0, t1
522 		xori	t0, STATMASK & ~1
523 		mtc0	t0, CP0_STATUS
524 #else /* CONFIG_MIPS_MT_SMTC */
525 		/*
526 		 * For SMTC, we need to set privilege
527 		 * and enable interrupts only for the
528 		 * current TC, using the TCStatus register.
529 		 */
530 		_ehb
531 		mfc0	t0, CP0_TCSTATUS
532 		/* Fortunately CU 0 is in the same place in both registers */
533 		/* Set TCU0, TKSU (for later inversion) and IXMT */
534 		li	t1, ST0_CU0 | 0x08001c00
535 		or	t0, t1
536 		/* Clear TKSU *and* IXMT */
537 		xori	t0, 0x00001c00
538 		mtc0	t0, CP0_TCSTATUS
539 		_ehb
540 		/* We need to leave the global IE bit set, but clear EXL...*/
541 		mfc0	t0, CP0_STATUS
542 		ori	t0, ST0_EXL
543 		xori	t0, ST0_EXL
544 		mtc0	t0, CP0_STATUS
545 		/* irq_enable_hazard below should expand to EHB for 24K/34K cpus */
546 #endif /* CONFIG_MIPS_MT_SMTC */
547 		irq_enable_hazard
548 		.endm
549 
550 /*
551  * Just move to kernel mode and leave interrupts as they are.  Note
552  * for the R3000 this means copying the previous enable from IEp.
553  * Set cp0 enable bit as sign that we're running on the kernel stack
554  */
555 		.macro	KMODE
556 #ifdef CONFIG_MIPS_MT_SMTC
557 		/*
558 		 * This gets baroque in SMTC.  We want to
559 		 * protect the non-atomic clearing of EXL
560 		 * with DMT/EMT, but we don't want to take
561 		 * an interrupt while DMT is still in effect.
562 		 */
563 
564 		/* KMODE gets invoked from both reorder and noreorder code */
565 		.set	push
566 		.set	mips32r2
567 		.set	noreorder
568 		mfc0	v0, CP0_TCSTATUS
569 		andi	v1, v0, TCSTATUS_IXMT
570 		ori	v0, TCSTATUS_IXMT
571 		mtc0	v0, CP0_TCSTATUS
572 		_ehb
573 		DMT	2				# dmt	v0
574 		/*
575 		 * We don't know a priori if ra is "live"
576 		 */
577 		move	t0, ra
578 		jal	mips_ihb
579 		nop	/* delay slot */
580 		move	ra, t0
581 #endif /* CONFIG_MIPS_MT_SMTC */
582 		mfc0	t0, CP0_STATUS
583 		li	t1, ST0_CU0 | (STATMASK & ~1)
584 #if defined(CONFIG_CPU_R3000) || defined(CONFIG_CPU_TX39XX)
585 		andi	t2, t0, ST0_IEP
586 		srl	t2, 2
587 		or	t0, t2
588 #endif
589 		or	t0, t1
590 		xori	t0, STATMASK & ~1
591 		mtc0	t0, CP0_STATUS
592 #ifdef CONFIG_MIPS_MT_SMTC
593 		_ehb
594 		andi	v0, v0, VPECONTROL_TE
595 		beqz	v0, 2f
596 		nop	/* delay slot */
597 		emt
598 2:
599 		mfc0	v0, CP0_TCSTATUS
600 		/* Clear IXMT, then OR in previous value */
601 		ori	v0, TCSTATUS_IXMT
602 		xori	v0, TCSTATUS_IXMT
603 		or	v0, v1, v0
604 		mtc0	v0, CP0_TCSTATUS
605 		/*
606 		 * irq_disable_hazard below should expand to EHB
607 		 * on 24K/34K CPUS
608 		 */
609 		.set pop
610 #endif /* CONFIG_MIPS_MT_SMTC */
611 		irq_disable_hazard
612 		.endm
613 
614 #endif /* _ASM_STACKFRAME_H */
615