Identification logic:
Added logic to backup and search again if the robot makes it to the
waypoint it wanted to get to without being ubstructed by a block.