WIP: add KdTree phase1, not compiled
WIP: Add KdTree phase2, compiled
WIP: twick sampling paras