Implemented BoxSearch and SegmentSearch for Box2D