| @@ -0,0 +1,78 @@ |
| | 1 | #include "lib9.h" |
| | 2 | #include "fpuctl.h" |
| | 3 | #include "mathi.h" |
| | 4 | |
| | 5 | void |
| | 6 | FPinit(void) |
| | 7 | { |
| | 8 | setfsr(0); /* Clear pending exceptions */ |
| | 9 | setfcr(FPPDBL|FPRNR|FPINVAL|FPZDIV|FPUNFL|FPOVFL); |
| | 10 | } |
| | 11 | |
| | 12 | ulong |
| | 13 | getFPstatus(void) |
| | 14 | { |
| | 15 | ulong fsr = 0, fsr9 = getfsr(); |
| | 16 | /* on specific machines, could be table lookup */ |
| | 17 | if(fsr9&FPAINEX) fsr |= INEX; |
| | 18 | if(fsr9&FPAOVFL) fsr |= OVFL; |
| | 19 | if(fsr9&FPAUNFL) fsr |= UNFL; |
| | 20 | if(fsr9&FPAZDIV) fsr |= ZDIV; |
| | 21 | if(fsr9&FPAINVAL) fsr |= INVAL; |
| | 22 | return fsr; |
| | 23 | } |
| | 24 | |
| | 25 | ulong |
| | 26 | FPstatus(ulong fsr, ulong mask) |
| | 27 | { |
| | 28 | ulong fsr9 = 0; |
| | 29 | ulong old = getFPstatus(); |
| | 30 | fsr = (fsr&mask) | (old&~mask); |
| | 31 | if(fsr&INEX) fsr9 |= FPAINEX; |
| | 32 | if(fsr&OVFL) fsr9 |= FPAOVFL; |
| | 33 | if(fsr&UNFL) fsr9 |= FPAUNFL; |
| | 34 | if(fsr&ZDIV) fsr9 |= FPAZDIV; |
| | 35 | if(fsr&INVAL) fsr9 |= FPAINVAL; |
| | 36 | setfsr(fsr9); |
| | 37 | return(old&mask); |
| | 38 | } |
| | 39 | |
| | 40 | ulong |
| | 41 | getFPcontrol(void) |
| | 42 | { |
| | 43 | ulong fcr = 0, fcr9 = getfcr(); |
| | 44 | switch(fcr9&FPRMASK){ |
| | 45 | case FPRNR: fcr = RND_NR; break; |
| | 46 | case FPRNINF: fcr = RND_NINF; break; |
| | 47 | case FPRPINF: fcr = RND_PINF; break; |
| | 48 | case FPRZ: fcr = RND_Z; break; |
| | 49 | } |
| | 50 | if(fcr9&FPINEX) fcr |= INEX; |
| | 51 | if(fcr9&FPOVFL) fcr |= OVFL; |
| | 52 | if(fcr9&FPUNFL) fcr |= UNFL; |
| | 53 | if(fcr9&FPZDIV) fcr |= ZDIV; |
| | 54 | if(fcr9&FPINVAL) fcr |= INVAL; |
| | 55 | return fcr; |
| | 56 | } |
| | 57 | |
| | 58 | ulong |
| | 59 | FPcontrol(ulong fcr, ulong mask) |
| | 60 | { |
| | 61 | ulong fcr9 = FPPDBL; |
| | 62 | ulong old = getFPcontrol(); |
| | 63 | fcr = (fcr&mask) | (old&~mask); |
| | 64 | if(fcr&INEX) fcr9 |= FPINEX; |
| | 65 | if(fcr&OVFL) fcr9 |= FPOVFL; |
| | 66 | if(fcr&UNFL) fcr9 |= FPUNFL; |
| | 67 | if(fcr&ZDIV) fcr9 |= FPZDIV; |
| | 68 | if(fcr&INVAL) fcr9 |= FPINVAL; |
| | 69 | switch(fcr&RND_MASK){ |
| | 70 | case RND_NR: fcr9 |= FPRNR; break; |
| | 71 | case RND_NINF: fcr9 |= FPRNINF; break; |
| | 72 | case RND_PINF: fcr9 |= FPRPINF; break; |
| | 73 | case RND_Z: fcr9 |= FPRZ; break; |
| | 74 | } |
| | 75 | setfcr(fcr9); |
| | 76 | return(old&mask); |
| | 77 | } |
| | 78 | |