Square distance instead of rooted one
Finishing with week5
Added tests for KdTree.java