set stop_smoothing_dist to 0.05 to smooth only at the very end of trajectory to avoid eband-bug