Fix BodyNode::setMass()