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

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