consider recalculating occdist_scale dynamically to increase the clearance from obstacles when the robot is far from the goal

[rayvburn]

Increasing the occdist_scale aims to lower the frequency of entering the "Rotate and Recede" recovery (especially in the real-world experiments).

Increasing the occdist_scale without reducing it near the goal may cause oscillations while preparing to reach the goal position.