Calculate next path point using lookahead for Graceful Controller#5003

SteveMacenski merged 10 commits into

ros-navigation:mainros-navigation/navigation2:mainfrom

SakshayMahna:mainSakshayMahna/navigation2:mainCopy head branch name to clipboard