(Untested) Completed kd-tree rewrite
Added default kd_node constructor