Fix BST Implementation & fix test harness