6 const double PI = 3.1415926535897932384626433832795;
7 const double PI2 = 1.5707963267948965579989817342721;
8 const double SPI = 1.7724538509055160272981674833411;
9 const double EPSILON = 0.000001;
12 inline T sgn(
const T a) {
return (a == 0 ? 0 : a < 0 ? -1 : 1); }
13 inline double picut(
double x) {
return x < 0 ? fmod(x-PI, 2*PI)+PI : fmod(x+PI, 2*PI)-PI;}