path planning fix