Optimal transition trajectory for waypoint following | IEEE Conference Publication | IEEE Xplore