First decent NN attempt
Working kd-tree
Added more comments
Updated readme