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