path planning bug fix