Created new, simplified QuadTree implementation. General code cleanup