Index: OSGMath.h
===================================================================
--- OSGMath.h   (revision 91664)
+++ OSGMath.h   (working copy)
@@ -70,6 +70,38 @@
    return a.x() * b.y() - b.x() * a.y();
 }

+/**
+ * wrapAngle - Приводит значение угла к соответствующему значению из полуинтервала [-Pi, Pi)
+ */
+inline double wrapAngle(const double& angle)
+{
+   double wrappedAngle = angle;
+   if (wrappedAngle < -M_PI)
+       while (wrappedAngle < -M_PI)
+           wrappedAngle += 2*M_PI;
+   else if (wrappedAngle >= M_PI)
+       while (wrappedAngle >= M_PI)
+           wrappedAngle -= 2*M_PI;
+
+    return wrappedAngle;
 }

+/**
+ * wrapAngle0_2Pi - Приводит значение угла к соответствующему значению из полуинтервала [0, 2*Pi)
+ */
+inline double wrapAngle0_2Pi(const double& angle)
+{
+   double wrappedAngle = angle;
+   if (wrappedAngle < 0)
+       while (wrappedAngle < 0)
+           wrappedAngle += 2*M_PI;
+   else if (wrappedAngle >= 2*M_PI)
+       while (wrappedAngle >= 2*M_PI)
+           wrappedAngle -= 2*M_PI;
+
+    return wrappedAngle;
+}
+
+}
+
 #endif
\ No newline at end of file