fixed same wrong assignment as in commit #5f8ad55a7cc26849331b82f7054243703c132af7
fixed same wrong assignment as in commit #5f8ad55a7cc26849331b82f7054243703c132af7

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