xref: /openbmc/linux/arch/mips/kernel/r2300_fpu.S (revision 9123e3a7)
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/asmmacro.h>
16#include <asm/errno.h>
17#include <asm/export.h>
18#include <asm/fpregdef.h>
19#include <asm/mipsregs.h>
20#include <asm/asm-offsets.h>
21#include <asm/regdef.h>
22
23#define EX(a,b)							\
249:	a,##b;							\
25	.section __ex_table,"a";				\
26	PTR	9b,fault;					\
27	.previous
28
29#define EX2(a,b)						\
309:	a,##b;							\
31	.section __ex_table,"a";				\
32	PTR	9b,bad_stack;					\
33	PTR	9b+4,bad_stack;					\
34	.previous
35
36	.set	mips1
37
38/*
39 * Save a thread's fp context.
40 */
41LEAF(_save_fp)
42EXPORT_SYMBOL(_save_fp)
43	fpu_save_single a0, t1			# clobbers t1
44	jr	ra
45	END(_save_fp)
46
47/*
48 * Restore a thread's fp context.
49 */
50LEAF(_restore_fp)
51	fpu_restore_single a0, t1		# clobbers t1
52	jr	ra
53	END(_restore_fp)
54
55	.set	noreorder
56
57/**
58 * _save_fp_context() - save FP context from the FPU
59 * @a0 - pointer to fpregs field of sigcontext
60 * @a1 - pointer to fpc_csr field of sigcontext
61 *
62 * Save FP context, including the 32 FP data registers and the FP
63 * control & status register, from the FPU to signal context.
64 */
65LEAF(_save_fp_context)
66	.set	push
67	SET_HARDFLOAT
68	li	v0, 0					# assume success
69	cfc1	t1, fcr31
70	EX2(s.d $f0, 0(a0))
71	EX2(s.d $f2, 16(a0))
72	EX2(s.d $f4, 32(a0))
73	EX2(s.d $f6, 48(a0))
74	EX2(s.d $f8, 64(a0))
75	EX2(s.d $f10, 80(a0))
76	EX2(s.d $f12, 96(a0))
77	EX2(s.d $f14, 112(a0))
78	EX2(s.d $f16, 128(a0))
79	EX2(s.d $f18, 144(a0))
80	EX2(s.d $f20, 160(a0))
81	EX2(s.d $f22, 176(a0))
82	EX2(s.d $f24, 192(a0))
83	EX2(s.d $f26, 208(a0))
84	EX2(s.d $f28, 224(a0))
85	EX2(s.d $f30, 240(a0))
86	jr	ra
87	 EX(sw	t1, (a1))
88	.set	pop
89	END(_save_fp_context)
90
91/**
92 * _restore_fp_context() - restore FP context to the FPU
93 * @a0 - pointer to fpregs field of sigcontext
94 * @a1 - pointer to fpc_csr field of sigcontext
95 *
96 * Restore FP context, including the 32 FP data registers and the FP
97 * control & status register, from signal context to the FPU.
98 */
99LEAF(_restore_fp_context)
100	.set	push
101	SET_HARDFLOAT
102	li	v0, 0					# assume success
103	EX(lw t0, (a1))
104	EX2(l.d $f0, 0(a0))
105	EX2(l.d $f2, 16(a0))
106	EX2(l.d $f4, 32(a0))
107	EX2(l.d $f6, 48(a0))
108	EX2(l.d $f8, 64(a0))
109	EX2(l.d $f10, 80(a0))
110	EX2(l.d $f12, 96(a0))
111	EX2(l.d $f14, 112(a0))
112	EX2(l.d $f16, 128(a0))
113	EX2(l.d $f18, 144(a0))
114	EX2(l.d $f20, 160(a0))
115	EX2(l.d $f22, 176(a0))
116	EX2(l.d $f24, 192(a0))
117	EX2(l.d $f26, 208(a0))
118	EX2(l.d $f28, 224(a0))
119	EX2(l.d $f30, 240(a0))
120	jr	ra
121	 ctc1	t0, fcr31
122	.set	pop
123	END(_restore_fp_context)
124	.set	reorder
125
126	.type	fault, @function
127	.ent	fault
128fault:	li	v0, -EFAULT
129	jr	ra
130	.end	fault
131