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