ref: 79c64a79a248c31733d4ec0ff9fe1a1e57a58f51
dir: /os/mpc/fp.s/
/* * support for floating-point hardware */ #include "mem.h" /* on some models mtmsr doesn't synchronise enough (eg, 603e) */ #define MSRSYNC SYNC; ISYNC #define FPON(X, Y)\ MOVW MSR, X;\ OR $FPE, X, Y;\ SYNC;\ ISYNC;\ MOVW Y, MSR;\ MSRSYNC #define FPOFF(X,Y)\ MOVW MSR, X;\ RLWNM $0, X, $~FPE, Y;\ SYNC;\ ISYNC;\ MOVW Y, MSR;\ MSRSYNC #define FPPREV(X)\ SYNC;\ ISYNC;\ MOVW X, MSR;\ MSRSYNC TEXT kfpinit(SB), $0 MOVFL $0,FPSCR(7) MOVFL $0xD,FPSCR(6) /* VE, OE, ZE */ MOVFL $0, FPSCR(5) MOVFL $0, FPSCR(3) MOVFL $0, FPSCR(2) MOVFL $0, FPSCR(1) MOVFL $0, FPSCR(0) FMOVD $4503601774854144.0, F27 FMOVD $0.5, F29 FSUB F29, F29, F28 FADD F29, F29, F30 FADD F30, F30, F31 FMOVD F28, F0 FMOVD F28, F1 FMOVD F28, F2 FMOVD F28, F3 FMOVD F28, F4 FMOVD F28, F5 FMOVD F28, F6 FMOVD F28, F7 FMOVD F28, F8 FMOVD F28, F9 FMOVD F28, F10 FMOVD F28, F11 FMOVD F28, F12 FMOVD F28, F13 FMOVD F28, F14 FMOVD F28, F15 FMOVD F28, F16 FMOVD F28, F17 FMOVD F28, F18 FMOVD F28, F19 FMOVD F28, F20 FMOVD F28, F21 FMOVD F28, F22 FMOVD F28, F23 FMOVD F28, F24 FMOVD F28, F25 FMOVD F28, F26 RETURN TEXT getfpscr(SB), $8 FPON(R4, R5) MOVFL FPSCR, F3 FMOVD F3, -8(SP) MOVW -4(SP), R3 FPPREV(R4) RETURN TEXT fpsave(SB), $0 FPON(R4, R4) FMOVD F0,0(R3) FMOVD F1,8(R3) FMOVD F2,16(R3) FMOVD F3,24(R3) FMOVD F4,32(R3) FMOVD F5,40(R3) FMOVD F6,48(R3) FMOVD F7,56(R3) FMOVD F8,64(R3) FMOVD F9,72(R3) FMOVD F10,80(R3) FMOVD F11,88(R3) FMOVD F12,96(R3) FMOVD F13,104(R3) FMOVD F14,112(R3) FMOVD F15,120(R3) FMOVD F16,128(R3) FMOVD F17,136(R3) FMOVD F18,144(R3) FMOVD F19,152(R3) FMOVD F20,160(R3) FMOVD F21,168(R3) FMOVD F22,176(R3) FMOVD F23,184(R3) FMOVD F24,192(R3) FMOVD F25,200(R3) FMOVD F26,208(R3) FMOVD F27,216(R3) FMOVD F28,224(R3) FMOVD F29,232(R3) FMOVD F30,240(R3) FMOVD F31,248(R3) MOVFL FPSCR, F0 FMOVD F0, 256(R3) MOVFL $0,FPSCR(7) MOVFL $0xD,FPSCR(6) /* VE, OE, ZE */ MOVFL $0, FPSCR(5) MOVFL $0, FPSCR(4) MOVFL $0, FPSCR(3) MOVFL $0, FPSCR(2) MOVFL $0, FPSCR(1) MOVFL $0, FPSCR(0) FPOFF(R4, R4) RETURN TEXT fprestore(SB), $0 FPON(R4, R4) FMOVD 256(R3), F0 MOVFL F0, FPSCR FMOVD 0(R3), F0 FMOVD 8(R3), F1 FMOVD 16(R3), F2 FMOVD 24(R3), F3 FMOVD 32(R3), F4 FMOVD 40(R3), F5 FMOVD 48(R3), F6 FMOVD 56(R3), F7 FMOVD 64(R3), F8 FMOVD 72(R3), F9 FMOVD 80(R3), F10 FMOVD 88(R3), F11 FMOVD 96(R3), F12 FMOVD 104(R3), F13 FMOVD 112(R3), F14 FMOVD 120(R3), F15 FMOVD 128(R3), F16 FMOVD 136(R3), F17 FMOVD 144(R3), F18 FMOVD 152(R3), F19 FMOVD 160(R3), F20 FMOVD 168(R3), F21 FMOVD 176(R3), F22 FMOVD 184(R3), F23 FMOVD 192(R3), F24 FMOVD 200(R3), F25 FMOVD 208(R3), F26 FMOVD 216(R3), F27 FMOVD 224(R3), F28 FMOVD 232(R3), F29 FMOVD 240(R3), F30 FMOVD 248(R3), F31 RETURN TEXT clrfptrap(SB), $0 FPON(R4, R5) MOVFL $0, FPSCR(5) MOVFL $0, FPSCR(3) MOVFL $0, FPSCR(2) MOVFL $0, FPSCR(1) MOVFL $0, FPSCR(0) FPPREV(R4) RETURN TEXT fpinit(SB), $0 FPON(R4, R5) BL kfpinit(SB) RETURN TEXT fpoff(SB), $0 FPOFF(R4, R5) RETURN TEXT FPsave(SB), 1, $0 FPON(R4, R5) MOVFL FPSCR, F0 FMOVD F0, 0(R3) FPPREV(R4) RETURN TEXT FPrestore(SB), 1, $0 FPON(R4, R5) FMOVD 0(R3), F0 MOVFL F0, FPSCR FPPREV(R4) RETURN