|
|
@ -675,28 +675,6 @@ namespace |
|
|
|
/////////////////////////////////////////
|
|
|
|
/////////////////////////////////////////
|
|
|
|
// POSITION & SCALE & ROTATION
|
|
|
|
// POSITION & SCALE & ROTATION
|
|
|
|
|
|
|
|
|
|
|
|
double toRad(double a) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
return a * CV_PI / 180.0; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
double clampAngle(double a) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
double res = a; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
while (res > 360.0) |
|
|
|
|
|
|
|
res -= 360.0; |
|
|
|
|
|
|
|
while (res < 0) |
|
|
|
|
|
|
|
res += 360.0; |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return res; |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
bool angleEq(double a, double b, double eps = 1.0) |
|
|
|
|
|
|
|
{ |
|
|
|
|
|
|
|
return (fabs(clampAngle(a - b)) <= eps); |
|
|
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
class GHT_Guil_Full : public GHT_Pos |
|
|
|
class GHT_Guil_Full : public GHT_Pos |
|
|
|
{ |
|
|
|
{ |
|
|
|
public: |
|
|
|
public: |
|
|
|