Fix BodyNode::fitWorldLinearVel() and BodyNode::fitWorldAngularVel()

When the linear velocity is being fitted, angular velocity is fixed and vice versa.