KD-Tree implementation. Move to FMap's spatial index directory.