path planning with unknown robot and goal position