[Box2d] Improve Box2D performance