Our code team has created functions that basically uses a quadrature enocoder attached to both drive wheel axis to read the speed of the motor. We then use a PID loop to adjust the motor speed appropriately. We're testing the code now. Once we get it all worked out I'll see if I can post it here.
