fixed some buggs in engine_steering_command function
Merge branch 'steering_algorithm' of https://github.com/TSEA56-2014-Grupp-1/Lagerrobot into steering_algorithm