Add exact path following in rpp for feasible plans#5496

mini-1235 wants to merge 4 commits intoros-navigation:mainros-navigation/navigation2:mainfrom

mini-1235:feat/rpp_cuspmini-1235/navigation2:feat/rpp_cuspCopy head branch name to clipboard