[control] replan path if too far from path