Fixed baseVelocity by adding additional -1 gain block for joint angular velocities