Вот по этому алгоритму и писал. Я же приложил код. Но все равно что то не так, движок начинает схватывать т.е. находится в напряжении, но все равно не крутится.
давно не миниботился в миниботе первом, другого у меня нет, движком управляли примерно так: на одной ноге выставляли направление вращения, а на другой шимом меняли скорость вращения. если без шима то просто вкл выкл движка.