Box2DWorld improvements, additions and optimizations

See commits for details.