Fixed undefined variable on additional_waypoint