Optimize rviz animation by controller smoother