added joint vel to velocity integrator