changes to human aware navigation to handle new goals wothout outputting failure