Added stop/hold position functionality to velocity command