Convert TraverseState::new_goals and TraverseState::removed_goals into std::vector and push/pop instead of insert/erase.

Convert TraverseState::new_goals and TraverseState::removed_goals into std::vector and push/pop instead of insert/erase. #2393