Would this make DriveStraight work?

The relevant code is in ```execute()```.