path planning fixes