Quadtree class finished, not tested