QuadTree for rapid collision detection and sensor updates
Performance improvements to QuadTree class
Removed redundant code from simulator
Merged with physics branch