Re-add BodyNode::getMassTensor() (used to be in class Shape)