Localization and reaching the goal finished. Note: Sometime with too many calibrations the plan is aborted