sv along path now computable + starting pos for replanning to fastplanner