KDTree working
made kdtree more generic, added first Hoppe implementation