Added InsertFix function, which preserve the red-black tree