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

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