First version of velocity control added