Quadtree working, looking into optimizations