Refactor and fix some BST mistakes, added succ and pred