pub fn estimate_location( grid: StandardGrid, cv_location: Option<Point2<i8>>, distance_sensors: [Result<Option<f32>, ()>; 4], robot_radius: f32, max_toi: f32, do_cv_adjust: bool, ) -> Option<Point2<f32>>