hc
2024-12-19 9370bb92b2d16684ee45cf24e879c93c509162da
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
/*
 * 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/asmmacro.h>
#include <asm/errno.h>
#include <asm/export.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,fault;                    \
   PTR    9b+4,fault;                    \
   .previous
 
   .set    mips1
 
/*
 * Save a thread's fp context.
 */
LEAF(_save_fp)
EXPORT_SYMBOL(_save_fp)
   fpu_save_single a0, t1            # clobbers t1
   jr    ra
   END(_save_fp)
 
/*
 * Restore a thread's fp context.
 */
LEAF(_restore_fp)
   fpu_restore_single a0, t1        # clobbers t1
   jr    ra
   END(_restore_fp)
 
   .set    noreorder
 
/**
 * _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