rwgast:
Awesome thank you very much, do you happen to have any code using PID that keeps the wheels the same speed?
haha no, that's quite a bit way down the road. First I'm working on tracking where the robot is based on the encoder values (differentiate to find speeds, rotate vector depending on angle, integrate to get new distance).