Finished quad tree implementation. Added quad tree tests.
Minor extensions to math classes.