Moved coordinates correctness to separate function.
Added erasing elements from QuadTree.