changes to human aware navigation to handle new goals without outputting...

... failure