[mirror_ubuntu-jammy-kernel.git] / arch / mips / kernel / r2300_fpu.S

/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
 * Copyright (C) 1996, 1998 by Ralf Baechle
 *
 * Multi-arch abstraction and asm macros for easier reading:
 * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
 *
 * Further modifications to make this work:
 * Copyright (c) 1998 Harald Koerfgen
 */
#include <asm/asm.h>
#include <asm/errno.h>
#include <asm/fpregdef.h>
#include <asm/mipsregs.h>
#include <asm/asm-offsets.h>
#include <asm/regdef.h>

#define EX(a,b)							\
9:	a,##b;							\
	.section __ex_table,"a";				\
	PTR	9b,fault;					\
	.previous

#define EX2(a,b)						\
9:	a,##b;							\
	.section __ex_table,"a";				\
	PTR	9b,bad_stack;					\
	PTR	9b+4,bad_stack;					\
	.previous

	.set	noreorder
	.set	mips1

/**
 * _save_fp_context() - save FP context from the FPU
 * @a0 - pointer to fpregs field of sigcontext
 * @a1 - pointer to fpc_csr field of sigcontext
 *
 * Save FP context, including the 32 FP data registers and the FP
 * control & status register, from the FPU to signal context.
 */
LEAF(_save_fp_context)
	.set	push
	SET_HARDFLOAT
	li	v0, 0					# assume success
	cfc1	t1, fcr31
	EX2(s.d $f0, 0(a0))
	EX2(s.d $f2, 16(a0))
	EX2(s.d $f4, 32(a0))
	EX2(s.d $f6, 48(a0))
	EX2(s.d $f8, 64(a0))
	EX2(s.d $f10, 80(a0))
	EX2(s.d $f12, 96(a0))
	EX2(s.d $f14, 112(a0))
	EX2(s.d $f16, 128(a0))
	EX2(s.d $f18, 144(a0))
	EX2(s.d $f20, 160(a0))
	EX2(s.d $f22, 176(a0))
	EX2(s.d $f24, 192(a0))
	EX2(s.d $f26, 208(a0))
	EX2(s.d $f28, 224(a0))
	EX2(s.d $f30, 240(a0))
	jr	ra
	 EX(sw	t1, (a1))
	.set	pop
	END(_save_fp_context)

/**
 * _restore_fp_context() - restore FP context to the FPU
 * @a0 - pointer to fpregs field of sigcontext
 * @a1 - pointer to fpc_csr field of sigcontext
 *
 * Restore FP context, including the 32 FP data registers and the FP
 * control & status register, from signal context to the FPU.
 */
LEAF(_restore_fp_context)
	.set	push
	SET_HARDFLOAT
	li	v0, 0					# assume success
	EX(lw t0, (a1))
	EX2(l.d $f0, 0(a0))
	EX2(l.d $f2, 16(a0))
	EX2(l.d $f4, 32(a0))
	EX2(l.d $f6, 48(a0))
	EX2(l.d $f8, 64(a0))
	EX2(l.d $f10, 80(a0))
	EX2(l.d $f12, 96(a0))
	EX2(l.d $f14, 112(a0))
	EX2(l.d $f16, 128(a0))
	EX2(l.d $f18, 144(a0))
	EX2(l.d $f20, 160(a0))
	EX2(l.d $f22, 176(a0))
	EX2(l.d $f24, 192(a0))
	EX2(l.d $f26, 208(a0))
	EX2(l.d $f28, 224(a0))
	EX2(l.d $f30, 240(a0))
	jr	ra
	 ctc1	t0, fcr31
	.set	pop
	END(_restore_fp_context)
	.set	reorder

	.type	fault, @function
	.ent	fault
fault:	li	v0, -EFAULT
	jr	ra
	.end	fault
Commit	Line	Data
1da177e4 LT	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) 1996, 1998 by Ralf Baechle
	7	*
	8	* Multi-arch abstraction and asm macros for easier reading:
79add627	9	* Copyright (C) 1996 David S. Miller (davem@davemloft.net)
1da177e4 LT	10	*
	11	* Further modifications to make this work:
	12	* Copyright (c) 1998 Harald Koerfgen
	13	*/
	14	#include <asm/asm.h>
	15	#include <asm/errno.h>
	16	#include <asm/fpregdef.h>
	17	#include <asm/mipsregs.h>
048eb582	18	#include <asm/asm-offsets.h>
1da177e4 LT	19	#include <asm/regdef.h>
	20
	21	#define EX(a,b) \
	22	9: a,##b; \
	23	.section __ex_table,"a"; \
35938a00	24	PTR 9b,fault; \
1da177e4 LT	25	.previous
1da177e4 LT	26
f92722dc MR	27	#define EX2(a,b) \
	28	9: a,##b; \
	29	.section __ex_table,"a"; \
	30	PTR 9b,bad_stack; \
	31	PTR 9b+4,bad_stack; \
	32	.previous
	33
1da177e4 LT	34	.set noreorder
1da177e4 LT	35	.set mips1
758ef0a9 MR	36
	37	/**
	38	* _save_fp_context() - save FP context from the FPU
	39	* @a0 - pointer to fpregs field of sigcontext
	40	* @a1 - pointer to fpc_csr field of sigcontext
	41	*
	42	* Save FP context, including the 32 FP data registers and the FP
	43	* control & status register, from the FPU to signal context.
	44	*/
1da177e4	45	LEAF(_save_fp_context)
842dfc11 ML	46	.set push
842dfc11 ML	47	SET_HARDFLOAT
1da177e4	48	li v0, 0 # assume success
758ef0a9	49	cfc1 t1, fcr31
f92722dc MR	50	EX2(s.d $f0, 0(a0))
	51	EX2(s.d $f2, 16(a0))
	52	EX2(s.d $f4, 32(a0))
	53	EX2(s.d $f6, 48(a0))
	54	EX2(s.d $f8, 64(a0))
	55	EX2(s.d $f10, 80(a0))
	56	EX2(s.d $f12, 96(a0))
	57	EX2(s.d $f14, 112(a0))
	58	EX2(s.d $f16, 128(a0))
	59	EX2(s.d $f18, 144(a0))
	60	EX2(s.d $f20, 160(a0))
	61	EX2(s.d $f22, 176(a0))
	62	EX2(s.d $f24, 192(a0))
	63	EX2(s.d $f26, 208(a0))
	64	EX2(s.d $f28, 224(a0))
	65	EX2(s.d $f30, 240(a0))
1da177e4	66	jr ra
758ef0a9	67	EX(sw t1, (a1))
842dfc11	68	.set pop
1da177e4 LT	69	END(_save_fp_context)
1da177e4 LT	70
758ef0a9 MR	71	/**
	72	* _restore_fp_context() - restore FP context to the FPU
	73	* @a0 - pointer to fpregs field of sigcontext
	74	* @a1 - pointer to fpc_csr field of sigcontext
1da177e4	75	*
758ef0a9 MR	76	* Restore FP context, including the 32 FP data registers and the FP
758ef0a9 MR	77	* control & status register, from signal context to the FPU.
1da177e4 LT	78	*/
1da177e4 LT	79	LEAF(_restore_fp_context)
842dfc11 ML	80	.set push
842dfc11 ML	81	SET_HARDFLOAT
1da177e4	82	li v0, 0 # assume success
758ef0a9	83	EX(lw t0, (a1))
f92722dc MR	84	EX2(l.d $f0, 0(a0))
	85	EX2(l.d $f2, 16(a0))
	86	EX2(l.d $f4, 32(a0))
	87	EX2(l.d $f6, 48(a0))
	88	EX2(l.d $f8, 64(a0))
	89	EX2(l.d $f10, 80(a0))
	90	EX2(l.d $f12, 96(a0))
	91	EX2(l.d $f14, 112(a0))
	92	EX2(l.d $f16, 128(a0))
	93	EX2(l.d $f18, 144(a0))
	94	EX2(l.d $f20, 160(a0))
	95	EX2(l.d $f22, 176(a0))
	96	EX2(l.d $f24, 192(a0))
	97	EX2(l.d $f26, 208(a0))
	98	EX2(l.d $f28, 224(a0))
	99	EX2(l.d $f30, 240(a0))
1da177e4	100	jr ra
758ef0a9	101	ctc1 t0, fcr31
842dfc11	102	.set pop
1da177e4 LT	103	END(_restore_fp_context)
	104	.set reorder
	105
51ff5d77	106	.type fault, @function
1da177e4 LT	107	.ent fault
	108	fault: li v0, -EFAULT
	109	jr ra
	110	.end fault