Improved the quad tree impl a little, and written a improved test. Code currently fails the test