Fast Shortest Path Polyline Smoothing With G1 Continuity and Bounded Curvature