Finished QuadTree Algo