Added new waypoint