Damped Harmonic Smoother for Trajectory Planning and Vibration Suppression