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

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