Modify _addRedBlackTree,added test code, Status : Incomplete