Added velocity command and limits of 2 m/s