Revert "Trimmed the branch to only the nav_goals_generator sub directory"

This reverts commit fb035d19dcd5fa3500e7033e16bf76b603285c20.
Rebase from 'upstream'
Trimmed the branch to only the nav_goals_generator sub directory