Measure physics simulation step
Refactor PhysicsGeometry and PhysicsBody