Updated PWM threaded control for slow movements of the Lego robot