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