optimization in btMultiBody::fillConstraintJacobianMultiDof: only compute links between current link and root