xref: /openbmc/linux/arch/mips/kernel/r2300_fpu.S (revision 4e1a33b1)
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:
9 * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
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>
18#include <asm/asm-offsets.h>
19#include <asm/regdef.h>
20
21#define EX(a,b)							\
229:	a,##b;							\
23	.section __ex_table,"a";				\
24	PTR	9b,fault;					\
25	.previous
26
27#define EX2(a,b)						\
289:	a,##b;							\
29	.section __ex_table,"a";				\
30	PTR	9b,bad_stack;					\
31	PTR	9b+4,bad_stack;					\
32	.previous
33
34	.set	noreorder
35	.set	mips1
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 */
45LEAF(_save_fp_context)
46	.set	push
47	SET_HARDFLOAT
48	li	v0, 0					# assume success
49	cfc1	t1, fcr31
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))
66	jr	ra
67	 EX(sw	t1, (a1))
68	.set	pop
69	END(_save_fp_context)
70
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
75 *
76 * Restore FP context, including the 32 FP data registers and the FP
77 * control & status register, from signal context to the FPU.
78 */
79LEAF(_restore_fp_context)
80	.set	push
81	SET_HARDFLOAT
82	li	v0, 0					# assume success
83	EX(lw t0, (a1))
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))
100	jr	ra
101	 ctc1	t0, fcr31
102	.set	pop
103	END(_restore_fp_context)
104	.set	reorder
105
106	.type	fault, @function
107	.ent	fault
108fault:	li	v0, -EFAULT
109	jr	ra
110	.end	fault
111