#define BOOST_TEST_MODULE test_maths #include #include #include #include constexpr auto quarter_pi = pi / 4.F; using vecter_to_angle = std::tuple; BOOST_DATA_TEST_CASE(test_vector_yaw, boost::unit_test::data::make( {{north, 0}, {south, pi}, {west, half_pi}, {east, -half_pi}, {north + east, -quarter_pi}, {south + east, quarter_pi * -3}, {north + west, quarter_pi}, {south + west, quarter_pi * 3}}), v, a) { BOOST_CHECK_CLOSE(vector_yaw(v), a, 1.F); } using normalize_angle = std::tuple; BOOST_DATA_TEST_CASE(test_angle_normalize, boost::unit_test::data::make({ {0, 0}, {two_pi, 0}, {-two_pi, 0}, {half_pi, half_pi}, {-half_pi, -half_pi}, {half_pi * 3, -half_pi}, {-half_pi * 3, half_pi}, }), in, exp) { BOOST_CHECK_CLOSE(normalize(in), exp, 1); } using pos3_to_arc = std::tuple; BOOST_DATA_TEST_CASE(test_create_arc, boost::unit_test::data::make({ {{0, 0, 0}, north, east, {0, half_pi * 3}}, {{0, 0, 0}, west, east, {half_pi, half_pi * 3}}, {{0, 0, 0}, south, east, {pi, half_pi * 3}}, {{0, 0, 0}, east, north, {-half_pi, 0}}, {{0, 0, 0}, south, north, {pi, two_pi}}, }), c, s, e, a) { const Arc arc {c, s, e}; BOOST_REQUIRE_LT(arc.first, arc.second); BOOST_CHECK_CLOSE(arc.first, a.first, 1.F); BOOST_CHECK_CLOSE(arc.second, a.second, 1.F); }