pub fn shortcut_path_smoothing(
path: &Path2D,
max_iter: usize,
obstacle_list: &[CircleObstacle],
robot_radius: f64,
sample_step: f64,
) -> Path2Dpub fn shortcut_path_smoothing(
path: &Path2D,
max_iter: usize,
obstacle_list: &[CircleObstacle],
robot_radius: f64,
sample_step: f64,
) -> Path2D