Showing the changes to libmath (1 of 7 files). Show all
Unified · Split
| @@ -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 | + | |