Fully working QuadTree, collision and separation