Initial import.

include/wrnav/util/math.h

@@ -0,0 +1,39 @@
+#ifndef __WRNAV_UTIL_MATH_H
+#define __WRNAV_UTIL_MATH_H
+
+
+namespace wr {
+namespace util {
+
+
+const double Epsilon_double = 0.0001;
+const float  Epsilon_float = 0.0001;
+
+
+void
+DefaultEpsilon(double &epsilon)
+{
+	epsilon = Epsilon_double;
+}
+
+
+void
+DefaultEpsilon(float &epsilon)
+{
+	epsilon = Epsilon_float;
+}
+
+
+template <typename T>
+T
+WithinTolerance(T a, T b, T epsilon)
+{
+	return std::abs(a - b) < epsilon;
+}
+
+
+} // namespace util
+} // namespace wr
+
+
+#endif // __WRNAV_UTIL_MATH_H