A (not yet complete) k-d tree implementation in c++