def test_compute_translation_to_direction_angle_is_zero(self):
    i2Ui1_measured = Unit3(Point3(1, 0, 0))
    wTi2_estimated = Pose3(Rot3(), Point3(0, 0, 0))
    wTi1_estimated = Pose3(Rot3(), Point3(2, 0, 0))
    self.assertEqual(geometry_comparisons.compute_translation_to_direction_angle(i2Ui1_measured, wTi2_estimated, wTi1_estimated), 0.0)
def test_compute_translation_to_direction_angle_is_zero(self):
    i2Ui1_measured = Unit3(Point3(1, 0, 0))
    wTi2_estimated = Pose3(Rot3(), Point3(0, 0, 0))
    wTi1_estimated = Pose3(Rot3(), Point3(2, 0, 0))
    self.assertEqual(geometry_comparisons.compute_translation_to_direction_angle(i2Ui1_measured, wTi2_estimated, wTi1_estimated), 0.0)