In MPPI critics, threshold_to_consider check is done with withinPositionGoalTolerance which uses euclidian distance. Wouldn't it make more sense to use remaining path length instead?

Because for example if you have a circular path (from Hybrid A* etc.) as below and the goal is near the robot but at the back, currently robot will ignore the path and try to go directly to the goal.