Fixed FollowReference maneuver (getting stuck when reference was similar
to previous reference).
Merge branch 'master' of https://github.com/LSTS/dune.git