Optimal waypoint guidance, trajectory design and tracking | IEEE Conference Publication | IEEE Xplore