DriveStraight command with encoder