Fixed robot heading.
Merge branch 'master' of https://github.com/s093018/-02343_Gruppe5.git
Fixed robot heading.