Motor code to count for difference in wheels

edited so that the wheels turn at the same speed