Add BST Tree Successor function implementation