Changed the way velocityControl is implemented, now uses gazebo JointCmd
Added a simple jointLogger and commented some lines that show how to use it