Improved method of robotic path planning in pynamic window