step corrections and update of starting position in fastPlanner interface