Working on bstree, added unit test