Initial implementation of insert and contains. 1st attempt at draw method. New unit tests for KdTree.