Working path planning