Initial commit for kdtree