2 * Copyright (C) 1999 Eddie C. Dost (ecd@atecom.com)
5 #include <linux/types.h>
6 #include <linux/sched.h>
8 #include <asm/uaccess.h>
11 #include <asm/sfp-machine.h>
12 #include <math-emu/double.h>
14 #define FLOATFUNC(x) extern int x(void *, void *, void *, void *)
70 #define OP31 0x1f /* 31 */
71 #define LFS 0x30 /* 48 */
72 #define LFSU 0x31 /* 49 */
73 #define LFD 0x32 /* 50 */
74 #define LFDU 0x33 /* 51 */
75 #define STFS 0x34 /* 52 */
76 #define STFSU 0x35 /* 53 */
77 #define STFD 0x36 /* 54 */
78 #define STFDU 0x37 /* 55 */
79 #define OP59 0x3b /* 59 */
80 #define OP63 0x3f /* 63 */
84 #define LFSX 0x217 /* 535 */
85 #define LFSUX 0x237 /* 567 */
86 #define LFDX 0x257 /* 599 */
87 #define LFDUX 0x277 /* 631 */
88 #define STFSX 0x297 /* 663 */
89 #define STFSUX 0x2b7 /* 695 */
90 #define STFDX 0x2d7 /* 727 */
91 #define STFDUX 0x2f7 /* 759 */
92 #define STFIWX 0x3d7 /* 983 */
96 #define FDIVS 0x012 /* 18 */
97 #define FSUBS 0x014 /* 20 */
98 #define FADDS 0x015 /* 21 */
99 #define FSQRTS 0x016 /* 22 */
100 #define FRES 0x018 /* 24 */
101 #define FMULS 0x019 /* 25 */
102 #define FRSQRTES 0x01a /* 26 */
103 #define FMSUBS 0x01c /* 28 */
104 #define FMADDS 0x01d /* 29 */
105 #define FNMSUBS 0x01e /* 30 */
106 #define FNMADDS 0x01f /* 31 */
110 #define FDIV 0x012 /* 18 */
111 #define FSUB 0x014 /* 20 */
112 #define FADD 0x015 /* 21 */
113 #define FSQRT 0x016 /* 22 */
114 #define FSEL 0x017 /* 23 */
115 #define FRE 0x018 /* 24 */
116 #define FMUL 0x019 /* 25 */
117 #define FRSQRTE 0x01a /* 26 */
118 #define FMSUB 0x01c /* 28 */
119 #define FMADD 0x01d /* 29 */
120 #define FNMSUB 0x01e /* 30 */
121 #define FNMADD 0x01f /* 31 */
124 #define FCMPU 0x000 /* 0 */
125 #define FRSP 0x00c /* 12 */
126 #define FCTIW 0x00e /* 14 */
127 #define FCTIWZ 0x00f /* 15 */
128 #define FCMPO 0x020 /* 32 */
129 #define MTFSB1 0x026 /* 38 */
130 #define FNEG 0x028 /* 40 */
131 #define MCRFS 0x040 /* 64 */
132 #define MTFSB0 0x046 /* 70 */
133 #define FMR 0x048 /* 72 */
134 #define MTFSFI 0x086 /* 134 */
135 #define FNABS 0x088 /* 136 */
136 #define FABS 0x108 /* 264 */
137 #define MFFS 0x247 /* 583 */
138 #define MTFSF 0x2c7 /* 711 */
157 #ifdef CONFIG_MATH_EMULATION
159 record_exception(struct pt_regs
*regs
, int eflag
)
167 if (eflag
& EFLAG_OVERFLOW
)
169 if (eflag
& EFLAG_UNDERFLOW
)
171 if (eflag
& EFLAG_DIVZERO
)
173 if (eflag
& EFLAG_INEXACT
)
175 if (eflag
& EFLAG_INVALID
)
177 if (eflag
& EFLAG_VXSNAN
)
178 fpscr
|= FPSCR_VXSNAN
;
179 if (eflag
& EFLAG_VXISI
)
180 fpscr
|= FPSCR_VXISI
;
181 if (eflag
& EFLAG_VXIDI
)
182 fpscr
|= FPSCR_VXIDI
;
183 if (eflag
& EFLAG_VXZDZ
)
184 fpscr
|= FPSCR_VXZDZ
;
185 if (eflag
& EFLAG_VXIMZ
)
186 fpscr
|= FPSCR_VXIMZ
;
187 if (eflag
& EFLAG_VXVC
)
189 if (eflag
& EFLAG_VXSOFT
)
190 fpscr
|= FPSCR_VXSOFT
;
191 if (eflag
& EFLAG_VXSQRT
)
192 fpscr
|= FPSCR_VXSQRT
;
193 if (eflag
& EFLAG_VXCVI
)
194 fpscr
|= FPSCR_VXCVI
;
197 // fpscr &= ~(FPSCR_VX);
198 if (fpscr
& (FPSCR_VXSNAN
| FPSCR_VXISI
| FPSCR_VXIDI
|
199 FPSCR_VXZDZ
| FPSCR_VXIMZ
| FPSCR_VXVC
|
200 FPSCR_VXSOFT
| FPSCR_VXSQRT
| FPSCR_VXCVI
))
203 fpscr
&= ~(FPSCR_FEX
);
204 if (((fpscr
& FPSCR_VX
) && (fpscr
& FPSCR_VE
)) ||
205 ((fpscr
& FPSCR_OX
) && (fpscr
& FPSCR_OE
)) ||
206 ((fpscr
& FPSCR_UX
) && (fpscr
& FPSCR_UE
)) ||
207 ((fpscr
& FPSCR_ZX
) && (fpscr
& FPSCR_ZE
)) ||
208 ((fpscr
& FPSCR_XX
) && (fpscr
& FPSCR_XE
)))
213 return (fpscr
& FPSCR_FEX
) ? 1 : 0;
215 #endif /* CONFIG_MATH_EMULATION */
218 do_mathemu(struct pt_regs
*regs
)
220 void *op0
= 0, *op1
= 0, *op2
= 0, *op3
= 0;
221 unsigned long pc
= regs
->nip
;
225 #ifdef CONFIG_MATH_EMULATION
226 int (*func
)(void *, void *, void *, void *);
231 if (get_user(insn
, (u32
*)pc
))
234 switch (insn
>> 26) {
235 case LFS
: func
= lfs
; type
= D
; break;
236 case LFSU
: func
= lfs
; type
= DU
; break;
237 case LFD
: func
= lfd
; type
= D
; break;
238 case LFDU
: func
= lfd
; type
= DU
; break;
239 case STFS
: func
= stfs
; type
= D
; break;
240 case STFSU
: func
= stfs
; type
= DU
; break;
241 case STFD
: func
= stfd
; type
= D
; break;
242 case STFDU
: func
= stfd
; type
= DU
; break;
245 switch ((insn
>> 1) & 0x3ff) {
246 case LFSX
: func
= lfs
; type
= XE
; break;
247 case LFSUX
: func
= lfs
; type
= XEU
; break;
248 case LFDX
: func
= lfd
; type
= XE
; break;
249 case LFDUX
: func
= lfd
; type
= XEU
; break;
250 case STFSX
: func
= stfs
; type
= XE
; break;
251 case STFSUX
: func
= stfs
; type
= XEU
; break;
252 case STFDX
: func
= stfd
; type
= XE
; break;
253 case STFDUX
: func
= stfd
; type
= XEU
; break;
254 case STFIWX
: func
= stfiwx
; type
= XE
; break;
261 switch ((insn
>> 1) & 0x1f) {
262 case FDIVS
: func
= fdivs
; type
= AB
; break;
263 case FSUBS
: func
= fsubs
; type
= AB
; break;
264 case FADDS
: func
= fadds
; type
= AB
; break;
265 case FSQRTS
: func
= fsqrts
; type
= XB
; break;
266 case FRES
: func
= fres
; type
= XB
; break;
267 case FMULS
: func
= fmuls
; type
= AC
; break;
268 case FRSQRTES
: func
= frsqrtes
;type
= XB
; break;
269 case FMSUBS
: func
= fmsubs
; type
= ABC
; break;
270 case FMADDS
: func
= fmadds
; type
= ABC
; break;
271 case FNMSUBS
: func
= fnmsubs
; type
= ABC
; break;
272 case FNMADDS
: func
= fnmadds
; type
= ABC
; break;
280 switch ((insn
>> 1) & 0x1f) {
281 case FDIV
: func
= fdiv
; type
= AB
; break;
282 case FSUB
: func
= fsub
; type
= AB
; break;
283 case FADD
: func
= fadd
; type
= AB
; break;
284 case FSQRT
: func
= fsqrt
; type
= XB
; break;
285 case FRE
: func
= fre
; type
= XB
; break;
286 case FSEL
: func
= fsel
; type
= ABC
; break;
287 case FMUL
: func
= fmul
; type
= AC
; break;
288 case FRSQRTE
: func
= frsqrte
; type
= XB
; break;
289 case FMSUB
: func
= fmsub
; type
= ABC
; break;
290 case FMADD
: func
= fmadd
; type
= ABC
; break;
291 case FNMSUB
: func
= fnmsub
; type
= ABC
; break;
292 case FNMADD
: func
= fnmadd
; type
= ABC
; break;
299 switch ((insn
>> 1) & 0x3ff) {
300 case FCMPU
: func
= fcmpu
; type
= XCR
; break;
301 case FRSP
: func
= frsp
; type
= XB
; break;
302 case FCTIW
: func
= fctiw
; type
= XB
; break;
303 case FCTIWZ
: func
= fctiwz
; type
= XB
; break;
304 case FCMPO
: func
= fcmpo
; type
= XCR
; break;
305 case MTFSB1
: func
= mtfsb1
; type
= XCRB
; break;
306 case FNEG
: func
= fneg
; type
= XB
; break;
307 case MCRFS
: func
= mcrfs
; type
= XCRL
; break;
308 case MTFSB0
: func
= mtfsb0
; type
= XCRB
; break;
309 case FMR
: func
= fmr
; type
= XB
; break;
310 case MTFSFI
: func
= mtfsfi
; type
= XCRI
; break;
311 case FNABS
: func
= fnabs
; type
= XB
; break;
312 case FABS
: func
= fabs
; type
= XB
; break;
313 case MFFS
: func
= mffs
; type
= X
; break;
314 case MTFSF
: func
= mtfsf
; type
= XFLB
; break;
326 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
327 op1
= (void *)¤t
->thread
.TS_FPR((insn
>> 16) & 0x1f);
328 op2
= (void *)¤t
->thread
.TS_FPR((insn
>> 11) & 0x1f);
332 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
333 op1
= (void *)¤t
->thread
.TS_FPR((insn
>> 16) & 0x1f);
334 op2
= (void *)¤t
->thread
.TS_FPR((insn
>> 6) & 0x1f);
338 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
339 op1
= (void *)¤t
->thread
.TS_FPR((insn
>> 16) & 0x1f);
340 op2
= (void *)¤t
->thread
.TS_FPR((insn
>> 11) & 0x1f);
341 op3
= (void *)¤t
->thread
.TS_FPR((insn
>> 6) & 0x1f);
345 idx
= (insn
>> 16) & 0x1f;
346 sdisp
= (insn
& 0xffff);
347 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
348 op1
= (void *)((idx
? regs
->gpr
[idx
] : 0) + sdisp
);
352 idx
= (insn
>> 16) & 0x1f;
356 sdisp
= (insn
& 0xffff);
357 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
358 op1
= (void *)(regs
->gpr
[idx
] + sdisp
);
362 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
366 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
367 op1
= (void *)¤t
->thread
.TS_FPR((insn
>> 16) & 0x1f);
371 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
372 op1
= (void *)¤t
->thread
.TS_FPR((insn
>> 11) & 0x1f);
376 idx
= (insn
>> 16) & 0x1f;
377 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
379 if (((insn
>> 1) & 0x3ff) == STFIWX
)
380 op1
= (void *)(regs
->gpr
[(insn
>> 11) & 0x1f]);
384 op1
= (void *)(regs
->gpr
[idx
] + regs
->gpr
[(insn
>> 11) & 0x1f]);
390 idx
= (insn
>> 16) & 0x1f;
391 op0
= (void *)¤t
->thread
.TS_FPR((insn
>> 21) & 0x1f);
392 op1
= (void *)((idx
? regs
->gpr
[idx
] : 0)
393 + regs
->gpr
[(insn
>> 11) & 0x1f]);
397 op0
= (void *)®s
->ccr
;
398 op1
= (void *)((insn
>> 23) & 0x7);
399 op2
= (void *)¤t
->thread
.TS_FPR((insn
>> 16) & 0x1f);
400 op3
= (void *)¤t
->thread
.TS_FPR((insn
>> 11) & 0x1f);
404 op0
= (void *)®s
->ccr
;
405 op1
= (void *)((insn
>> 23) & 0x7);
406 op2
= (void *)((insn
>> 18) & 0x7);
410 op0
= (void *)((insn
>> 21) & 0x1f);
414 op0
= (void *)((insn
>> 23) & 0x7);
415 op1
= (void *)((insn
>> 12) & 0xf);
419 op0
= (void *)((insn
>> 17) & 0xff);
420 op1
= (void *)¤t
->thread
.TS_FPR((insn
>> 11) & 0x1f);
427 eflag
= func(op0
, op1
, op2
, op3
);
430 regs
->ccr
&= ~(0x0f000000);
431 regs
->ccr
|= (__FPU_FPSCR
>> 4) & 0x0f000000;
434 trap
= record_exception(regs
, eflag
);
441 regs
->gpr
[idx
] = (unsigned long)op1
;
This page took 0.049231 seconds and 5 git commands to generate.