00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023 inline
00024 bool feq(Real a, Real b, Real e ) {
00025 if(a == 0 && fabs(b) < e)
00026 return true;
00027
00028 if(b == 0 && fabs(a) < e)
00029 return true;
00030
00031 return fabs(a - b) < e * fabs(a);
00032 }
00033
00034 inline
00035 bool fneq(Real a, Real b, Real e ) {
00036 return !feq(a, b, e);
00037 }
00038
00039 inline
00040 bool fle(Real a, Real b, Real e ) {
00041 return a < b || feq(a, b, e);
00042 }
00043
00044 inline
00045 bool fge(Real a, Real b, Real e ) {
00046 return a > b || feq(a, b, e);
00047 }
00048
00049 inline
00050 bool fz(Real a, Real e ) {
00051 return fabs(a) < e;
00052 }
00053
00054 inline
00055 bool fnz(Real a, Real e ) {
00056 return fabs(a) >= e;
00057 }
00058
00059 template<typename T> inline
00060 T sq(T x) {
00061 return x * x;
00062 }
00063
00064 inline
00065 Real dtor(Real d) {
00066 return d * (PI / 180.0);
00067 }
00068
00069 inline
00070 Real rtod(Real r) {
00071 return r * (180.0 / PI);
00072 }
00073
00074 inline
00075 Real NormalizeAngle(Real angle) {
00076 angle = fmod(angle, 2.0 * PI);
00077 return angle < 0.0 ? angle + 2.0 * PI : angle;
00078 }
00079
00080 inline
00081 int NextPowerOfTwo(double x) {
00082 assert(x >= 1.0);
00083 return 1 << static_cast<int>(ceil(log(x) / log(2.0)));
00084 }