Files modified so that a robot that has a goal will attempt to move in recovery until it is sure where it is going, but only on startup.
Also allows the robot to replan routes when coming out of recovery mode