[mikets]

Are you going to use the encoders to drive straight or do you also want to use the encoders to turn a certain angle? Your code suggested you have 4-motor drive system. Are you doing mecanum or just normal wheels? Where are the encoders mounted? These questions are important to determine how the code is written.