Simple implementation fo c++ Quadtree