Make sure fixed curvature lookahead distance doesn't overshoot distance to cusp with RPP controller (backport #5134)#5135

SteveMacenski merged 1 commit intojazzyros-navigation/navigation2:jazzyfrom

mergify/bp/jazzy/pr-5134ros-navigation/navigation2:mergify/bp/jazzy/pr-5134Copy head branch name to clipboard