Simplify angleBetween to avoid cancellation losses
This commit is contained in:
committed by
Patrick Niklaus
parent
c535e74a65
commit
7a4c5a64fa
@@ -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()
|
||||
|
||||
Reference in New Issue
Block a user