pub fn simplify_path(waypoints: &[Vec2], tolerance: f32) -> Vec<Vec2>
Simplify a path by removing intermediate points within tolerance of the line.
tolerance