Ich vermute, dass dein Programm so schnell ausgeführt wird, dass die Motoren nicht hinterherkommen und das Ansteuerungssignal die meiste Zeit 255 beträgt.
Au0erdem fragst du die Variable LANG doch nirgends im Programm ab, wie soll er darauf reagieren können.