Add KDTree to compute faster nearest neighbors research.
Add DevicePtr_t robot in the roadmap constructor to get it for the KDTree class
rectify distances to squared distances. Add distance calculation for looped dimentions.
Debugged but still with the debug file writing.
delete debug file writing
version 1
Add unit test
adjust to emacs width
Delete DisplayConfig in node.cc
Merge branch 'kdTree'

Conflicts:
	src/node.cc
	src/roadmap.cc
Merge branch 'master' of https://github.com/humanoid-path-planner/hpp-core