Fixing oscillations in path follower when next target is behind robot
Merge branch 'devel' of https://github.com/ros-nao/nao_extras into devel