After experimenting a bit, I've noticed after running the simulate command some trajectories begin to gradually veer off further and further until they no longer seem to be reaching or optimizing for the goal position set in the script (see images below).
I have found some (small) improvement by reducing the planner learning rate a bit. I was wondering if there are any tips on improving the stability of this trajectory optimization, or if this is a known behavior?
After experimenting a bit, I've noticed after running the simulate command some trajectories begin to gradually veer off further and further until they no longer seem to be reaching or optimizing for the goal position set in the script (see images below).
I have found some (small) improvement by reducing the planner learning rate a bit. I was wondering if there are any tips on improving the stability of this trajectory optimization, or if this is a known behavior?