Rename BodyNode::setMomentOfInertia() to BodyNode::setInertia(), modify comments and remove wrong assertions.