def test_absolute_pose_n_points(one_shot_and_its_points): pose, bearings, points = one_shot_and_its_points result = pygeometry.absolute_pose_n_points(bearings, points) expected = pose.get_Rt() assert np.linalg.norm(expected-result, ord='fro') < 1e-6
def test_absolute_pose_n_points(shots_and_their_points): for pose, bearings, points in shots_and_their_points: result = pygeometry.absolute_pose_n_points(bearings, points) expected = pose.get_world_to_cam()[:3] assert np.linalg.norm(expected - result, ord="fro") < 1e-5
def test_absolute_pose_n_points(shots_and_their_points): for pose, bearings, points in shots_and_their_points: result = pygeometry.absolute_pose_n_points(bearings, points) expected = pose.get_Rt() assert np.linalg.norm(expected - result, ord='fro') < 1e-5