Move nav_goals_generator from strands_util

This is needed to fix https://github.com/strands-project/strands_hri/pull/79