One Month In Minsk. Made in Belarus.

1 files changed, 54 insertions, 0 deletions

diff --git a/geometry/geometry_tests/angle_test.cpp b/geometry/geometry_tests/angle_test.cpp
new file mode 100644
index 0000000000..c59bd66276
--- /dev/null
+++ b/geometry/geometry_tests/angle_test.cpp
@@ -0,0 +1,54 @@
+#include "../../base/SRC_FIRST.hpp"
+
+#include "equality.hpp"
+
+#include "../../base/macros.hpp"
+
+#include "../../testing/testing.hpp"
+
+#include "../angles.hpp"
+
+using namespace test;
+
+UNIT_TEST(Atan)
+{
+  double const h4 = math::pi/4.0;
+
+  TEST(is_equal_atan(1, 1, h4), ());
+  TEST(is_equal_atan(-1, 1, math::pi - h4), ());
+  TEST(is_equal_atan(-1, -1, h4 - math::pi), ());
+  TEST(is_equal_atan(1, -1, -h4), ());
+
+  double const hh = atan(1.0/2.0);
+
+  TEST(is_equal_atan(2, 1, hh), ());
+  TEST(is_equal_atan(-2, 1, math::pi - hh), ());
+  TEST(is_equal_atan(-2, -1, hh - math::pi), ());
+  TEST(is_equal_atan(2, -1, -hh), ());
+}
+
+namespace
+{
+  void check_avg(double arr[], size_t n, double v)
+  {
+    ang::AverageCalc calc;
+    for (size_t i = 0; i < n; ++i)
+      calc.Add(arr[i]);
+
+    double const avg = calc.GetAverage();
+    TEST(is_equal_angle(avg, v), (avg, v));
+  }
+}
+
+UNIT_TEST(Average)
+{
+  double const eps = 1.0E-3;
+
+  double arr1[] = { math::pi-eps, -math::pi+eps };
+  TEST(is_equal_angle(ang::GetMiddleAngle(arr1[0], arr1[1]), math::pi), ());
+  check_avg(arr1, ARRAY_SIZE(arr1), math::pi);
+
+  double arr2[] = { eps, -eps };
+  TEST(is_equal_angle(ang::GetMiddleAngle(arr2[0], arr2[1]), 0.0), ());
+  check_avg(arr2, ARRAY_SIZE(arr2), 0.0);
+}