use cfg_->trajectory.global_plan_overwrite_orientation upon reinit
use cfg_->trajectory.global_plan_overwrite_orientation upon reinit

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