Fix wrapping of computed angles in test_backwards_compatibility.py
parent
b2a351c8de
commit
8583185153
|
@ -472,9 +472,8 @@ class TestBackwardsCompatibility(GtsamTestCase):
|
||||||
wRi_list = [result_values.atRot2(i) for i in range(num_images)]
|
wRi_list = [result_values.atRot2(i) for i in range(num_images)]
|
||||||
thetas_deg = np.array([wRi.degrees() for wRi in wRi_list])
|
thetas_deg = np.array([wRi.degrees() for wRi in wRi_list])
|
||||||
|
|
||||||
# map all angles to [0,360)
|
# map all angles to [-180,180)
|
||||||
thetas_deg = thetas_deg % 360
|
thetas_deg = (thetas_deg - thetas_deg[0] + 180) % 360 - 180
|
||||||
thetas_deg -= thetas_deg[0]
|
|
||||||
|
|
||||||
expected_thetas_deg = np.array([0.0, 90.0, 0.0])
|
expected_thetas_deg = np.array([0.0, 90.0, 0.0])
|
||||||
np.testing.assert_allclose(thetas_deg, expected_thetas_deg, atol=0.1)
|
np.testing.assert_allclose(thetas_deg, expected_thetas_deg, atol=0.1)
|
||||||
|
|
Loading…
Reference in New Issue