Added velocity to the joint states