fixed bug in drive and door control
Merge branch 'master' of https://github.com/jalau/GRP22_18649