Translational Tolerance In Pathfinding

We have been encountering some issues with pathplanner’s pathfinding. when the robot’s current position is 0.5 meters or less away from it’s target position it does not move because of a translational tolerance that is incorporated into pathplanner in this code:

We have tried copying the code and changing the tolerance and it worked in the simulation.
We would love for you to help us to find a better solution.