[MPPI] Fix transformed path oscillations#3443

Merged

SteveMacenski merged 5 commits intoros-navigation:mainfrom

doisyg:fix_transformed_path_bound_search

Mar 7, 2023

Commits on Mar 2, 2023

use path distance instead of euclidean for upper bound search
Guillaume Doisy
committed

Commits on Mar 6, 2023

rename to pruned_plan_end
Guillaume Doisy
committed
rename to pruned_plan_end
Guillaume Doisy
committed
fix tests
Guillaume Doisy
committed

Commits on Mar 7, 2023

do not use prune_distance to limit the search for the closest pose
Guillaume Doisy
committed