Changed AutoDrive to (hopefully) work with new encoder setup