Fixed direction change in drive; Fixed disable safety in drive