Base version

Base logic for brute implemented.
KdTree partly implemented
All commit