made modifications such that the planner will plan close to the goal upto a tollerance