Simplify angleBetween to avoid cancellation losses

This commit is contained in:
Michael Krasnyk
2017-05-16 17:45:07 +02:00
committed by Patrick Niklaus
parent c535e74a65
commit 7a4c5a64fa
2 changed files with 24 additions and 9 deletions
+23
View File
@@ -51,6 +51,29 @@ BOOST_AUTO_TEST_CASE(bearing_angle_test)
{
BOOST_CHECK_EQUAL(bearing::angleBetween(257.78421507794314, 77.784215077943117), 0.);
BOOST_CHECK_EQUAL(bearing::angleBetween(77.784215077943117, 257.78421507794314), 0.);
// Check quadrants
BOOST_CHECK_EQUAL(bearing::angleBetween(45., 45.), 180.);
BOOST_CHECK_EQUAL(bearing::angleBetween(45., 315.), 270.);
BOOST_CHECK_EQUAL(bearing::angleBetween(45., 225.), 0.);
BOOST_CHECK_EQUAL(bearing::angleBetween(45., 135.), 90.);
BOOST_CHECK_EQUAL(bearing::angleBetween(45., 90.), 135.);
// Check edge cases
BOOST_CHECK_EQUAL(bearing::angleBetween(0., 360.), 180.);
BOOST_CHECK_EQUAL(bearing::angleBetween(360., 0.), 180.);
BOOST_CHECK_EQUAL(bearing::angleBetween(0., 0.), 180.);
BOOST_CHECK_EQUAL(bearing::angleBetween(360., 360.), 180.);
BOOST_CHECK_EQUAL(bearing::angleBetween(0., 180.), 0.);
BOOST_CHECK_EQUAL(bearing::angleBetween(360., 180.), 0.);
BOOST_CHECK_EQUAL(bearing::angleBetween(180., 0.), 0.);
BOOST_CHECK_EQUAL(bearing::angleBetween(180., 360.), 0.);
BOOST_CHECK_EQUAL(bearing::angleBetween(90., 270.01), 359.99);
// 5 digits loss due to cancellation in 90+180-269.99
BOOST_CHECK_CLOSE(bearing::angleBetween(90., 269.99), 0.01, 1e-10);
}
BOOST_AUTO_TEST_SUITE_END()