Add binary search tree iterative insertion operation
Fix bugs