Box2DWorld improvements, additions and optimizations