Finished cleaning up the non-collection based data structure testing code
Cleaned up the Interval Tree, KD-Tree, and Matrix test cases