Added Quadtree

Tiny bit of tidying too