forgot to push changes to autoResize   (the function adjusts time diffs (& poses)) --> decrement loop iterator after inserting or removing poses     (the updated time diff will be checked again)
forgot to push changes to autoResize
  (the function adjusts time diffs (& poses))
--> decrement loop iterator after inserting or removing poses
    (the updated time diff will be checked again)

rst-tu-dortmund/teb_local_planner,rst-tu-dortmund/teb_local_planner