Add BST Tree Insert function implementation