Bugfix: Reversing puts us off by 5cm