mostly fixed the encoders, attempted PID for straightDrive