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

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