FlProg

Помогите настроить управление вращением серводвигателя с постоянным вращением

Алгоритм следующий.
Каждые 5 секунд, двигатель должен вращаться в течение 1 секунды, если I1 >=I2 в одну сторону, иначе в другую.
Серв много поэтому подключены через плату расширения PCA9685
Серва постоянного вращения, как понял у него задается не угол поворота, а скорость вращения: 0 - вращение в одну сторону, 90 - стоп, 180 - вращение в другую сторону.

Через несимметричный мультивибратор задал длину импульса 1с и паузы 5 секунд.
Через блок SwitCh выдаю различные значения на Серв.
Подскажите это верная логика или я что-то напутал с понятием вращения серводвигателя?

UPD/ Что-то я подумал что "Таблица Состояний" там вообще лишняя.
Убрал, проект изменил

[ref]kuskov[/ref], а почему у Вас в воздухе входа I1 и I2,подайте на них что нибудь для начала.

[ref]Brand2[/ref], Это кусочек из полного кода. Хотя даже это не полный код, а только управление одним двигателем.

[ref]kuskov[/ref], я никогда не работал с PCA9685 SERVO и с серво с постоянным вращением,но попробуйте так,поставьте кнопку и ей изменяйте направление вращения Отправлено спустя 8 минут 4 секунды:
или так