fix(mission_planner): consider overlap lanelets when enable_correct_goal_pose param is true

fix(mission_planner): consider overlap lanelets when enable_correct_goal_pose param is true #25785