You'll probably get better answers on gamedev.stackexchange.com. Also I recommend checking out box2d's BVH tree implementation, you could reuse that.
↧