fn get_closest_point( loc: &Point2<f32>, path: &Vec<Point2<f32>, LOCAL_MAX_PATH_LENGTH>, i: usize, ) -> Point2<f32>