Detect when stuck and give up on the waypoint.

This required adding a waypoints_failed and goals_failed queue to pass
the failure notifications back up the stack to the manager.