new path planning is working