Beginning KDTree implementation. Methods implemented: constructors, size, empty, insert, and contains