Added velocity command and limits of 2 m/s
merge master