I think this new behavior is better because it avoids excess iterations.
With spacing of 0.5 in the current system, an extra 140ms would pass before 0,7 becomes the target. This is 140ms of "slew" that's introduced. Exit conditions also rely on what the current target is, creating edge cases where additional time is added before the robot will exit.
Point injecting should ignore the first few points.
From (0, 0) to (0, 24) in an injected pure pursuit, this would currently happen.
It should instead do this, where 7 is
LOOK_AHEAD
.I think this new behavior is better because it avoids excess iterations.
With spacing of 0.5 in the current system, an extra 140ms would pass before 0,7 becomes the target. This is 140ms of "slew" that's introduced. Exit conditions also rely on what the current target is, creating edge cases where additional time is added before the robot will exit.