1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <asm/reg.h>
18#include <asm/page.h>
19#include <asm/mmu.h>
20#include <asm/pgtable.h>
21#include <asm/cputable.h>
22#include <asm/cache.h>
23#include <asm/thread_info.h>
24#include <asm/ppc_asm.h>
25#include <asm/asm-offsets.h>
26#include <asm/ptrace.h>
27
28#ifdef CONFIG_VSX
29#define __REST_32FPVSRS(n,c,base) \
30BEGIN_FTR_SECTION \
31 b 2f; \
32END_FTR_SECTION_IFSET(CPU_FTR_VSX); \
33 REST_32FPRS(n,base); \
34 b 3f; \
352: REST_32VSRS(n,c,base); \
363:
37
38#define __REST_32FPVSRS_TRANSACT(n,c,base) \
39BEGIN_FTR_SECTION \
40 b 2f; \
41END_FTR_SECTION_IFSET(CPU_FTR_VSX); \
42 REST_32FPRS_TRANSACT(n,base); \
43 b 3f; \
442: REST_32VSRS_TRANSACT(n,c,base); \
453:
46
47#define __SAVE_32FPVSRS(n,c,base) \
48BEGIN_FTR_SECTION \
49 b 2f; \
50END_FTR_SECTION_IFSET(CPU_FTR_VSX); \
51 SAVE_32FPRS(n,base); \
52 b 3f; \
532: SAVE_32VSRS(n,c,base); \
543:
55#else
56#define __REST_32FPVSRS(n,b,base) REST_32FPRS(n, base)
57#define __REST_32FPVSRS_TRANSACT(n,b,base) REST_32FPRS(n, base)
58#define __SAVE_32FPVSRS(n,b,base) SAVE_32FPRS(n, base)
59#endif
60#define REST_32FPVSRS(n,c,base) __REST_32FPVSRS(n,__REG_
61#define REST_32FPVSRS_TRANSACT(n,c,base) \
62 __REST_32FPVSRS_TRANSACT(n,__REG_
63#define SAVE_32FPVSRS(n,c,base) __SAVE_32FPVSRS(n,__REG_
64
65#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
66
67
68
69
70_GLOBAL(do_load_up_fpu)
71 mflr r0
72 std r0, 16(r1)
73 stdu r1, -112(r1)
74
75 subi r6, r3, STACK_FRAME_OVERHEAD
76
77
78
79 ld r12,_MSR(r6)
80 GET_PACA(r13)
81
82 bl load_up_fpu
83 std r12,_MSR(r6)
84
85 ld r0, 112+16(r1)
86 addi r1, r1, 112
87 mtlr r0
88 blr
89
90
91
92
93
94
95
96
97_GLOBAL(do_load_up_transact_fpu)
98 mfmsr r6
99 ori r5,r6,MSR_FP
100#ifdef CONFIG_VSX
101BEGIN_FTR_SECTION
102 oris r5,r5,MSR_VSX@h
103END_FTR_SECTION_IFSET(CPU_FTR_VSX)
104#endif
105 SYNC
106 MTMSRD(r5)
107
108 lfd fr0,THREAD_TRANSACT_FPSCR(r3)
109 MTFSF_L(fr0)
110 REST_32FPVSRS_TRANSACT(0, R4, R3)
111
112
113 MTMSRD(r6)
114 SYNC
115
116 blr
117#endif
118
119
120
121
122
123
124
125
126_GLOBAL(load_up_fpu)
127 mfmsr r5
128 ori r5,r5,MSR_FP
129#ifdef CONFIG_VSX
130BEGIN_FTR_SECTION
131 oris r5,r5,MSR_VSX@h
132END_FTR_SECTION_IFSET(CPU_FTR_VSX)
133#endif
134 SYNC
135 MTMSRD(r5)
136 isync
137
138
139
140
141
142#ifndef CONFIG_SMP
143 LOAD_REG_ADDRBASE(r3, last_task_used_math)
144 toreal(r3)
145 PPC_LL r4,ADDROFF(last_task_used_math)(r3)
146 PPC_LCMPI 0,r4,0
147 beq 1f
148 toreal(r4)
149 addi r4,r4,THREAD
150 SAVE_32FPVSRS(0, R5, R4)
151 mffs fr0
152 stfd fr0,THREAD_FPSCR(r4)
153 PPC_LL r5,PT_REGS(r4)
154 toreal(r5)
155 PPC_LL r4,_MSR-STACK_FRAME_OVERHEAD(r5)
156 li r10,MSR_FP|MSR_FE0|MSR_FE1
157 andc r4,r4,r10
158 PPC_STL r4,_MSR-STACK_FRAME_OVERHEAD(r5)
1591:
160#endif
161
162#ifdef CONFIG_PPC32
163 mfspr r5,SPRN_SPRG_THREAD
164 lwz r4,THREAD_FPEXC_MODE(r5)
165 ori r9,r9,MSR_FP
166 or r9,r9,r4
167#else
168 ld r4,PACACURRENT(r13)
169 addi r5,r4,THREAD
170 lwz r4,THREAD_FPEXC_MODE(r5)
171 ori r12,r12,MSR_FP
172 or r12,r12,r4
173 std r12,_MSR(r1)
174#endif
175 lfd fr0,THREAD_FPSCR(r5)
176 MTFSF_L(fr0)
177 REST_32FPVSRS(0, R4, R5)
178#ifndef CONFIG_SMP
179 subi r4,r5,THREAD
180 fromreal(r4)
181 PPC_STL r4,ADDROFF(last_task_used_math)(r3)
182#endif
183
184
185 blr
186
187
188
189
190
191
192
193_GLOBAL(giveup_fpu)
194 mfmsr r5
195 ori r5,r5,MSR_FP
196#ifdef CONFIG_VSX
197BEGIN_FTR_SECTION
198 oris r5,r5,MSR_VSX@h
199END_FTR_SECTION_IFSET(CPU_FTR_VSX)
200#endif
201 SYNC_601
202 ISYNC_601
203 MTMSRD(r5)
204 SYNC_601
205 isync
206 PPC_LCMPI 0,r3,0
207 beqlr-
208 addi r3,r3,THREAD
209 PPC_LL r5,PT_REGS(r3)
210 PPC_LCMPI 0,r5,0
211 SAVE_32FPVSRS(0, R4 ,R3)
212 mffs fr0
213 stfd fr0,THREAD_FPSCR(r3)
214 beq 1f
215 PPC_LL r4,_MSR-STACK_FRAME_OVERHEAD(r5)
216 li r3,MSR_FP|MSR_FE0|MSR_FE1
217#ifdef CONFIG_VSX
218BEGIN_FTR_SECTION
219 oris r3,r3,MSR_VSX@h
220END_FTR_SECTION_IFSET(CPU_FTR_VSX)
221#endif
222 andc r4,r4,r3
223 PPC_STL r4,_MSR-STACK_FRAME_OVERHEAD(r5)
2241:
225#ifndef CONFIG_SMP
226 li r5,0
227 LOAD_REG_ADDRBASE(r4,last_task_used_math)
228 PPC_STL r5,ADDROFF(last_task_used_math)(r4)
229#endif
230 blr
231
232
233
234
235
236
237_GLOBAL(cvt_fd)
238 lfs 0,0(r3)
239 stfd 0,0(r4)
240 blr
241
242_GLOBAL(cvt_df)
243 lfd 0,0(r3)
244 stfs 0,0(r4)
245 blr
246