pub fn point_line_distance_3d(point: &Vec3, (start, end): &(Vec3, Vec3)) -> f64
Returns the distance of a point from a line.
This is used in the pathfinder for checking if the bot is too far from the current path.