def test_dist_point_to_line2(self): line_p = np.array([0., 0., 0.]) line_dir = np.array([1., 1., 1.]) dist = VecMath.dist_point_to_line(line_p, line_dir, np.array([0., .2, .5])) self.assertEqual(dist, 0.35590260840104376)
def test_dist_point_to_line(self): line_p = np.array([0., 0., 0.]) line_dir = np.array([1., 0., 0.]) dist = VecMath.dist_point_to_line(line_p, line_dir, np.array([-1., 2., 0.])) self.assertEqual(dist, 2.)