add the code

1. add swap_node_pair
2. tree repair