Initialize mass and inertia in constructor of BodyNode.