function counts = convert(angle)
% convert the virtual wheel angle to the real wheel angle
% then to timer compare value
y = atan(L/(L+d)*tan(angle));
counts = 40/9*y + 708 - 320;