С разгоном ШД в ФБ проблемы. Постоянное ускорение вероятно не катит.
Я подозреваю, что частота импульсов в ФБ генерируется не верно. Может синхронизироваться не от счетчика команд, а по прерываниям таймера. Зарядить таймер на 1мкс и формировать и отсчитывать периоды. Тогда все будет железно.
Что касается возможного джиттера, то он не страшен. ШД небольшое колебание фазы импульсов просто не заметит.
Может сделать два ФБ, один для ШД, другой для сервопривода. Дело в том, что ШД более капризная вещь, его труднее разогнать.





Ответить с цитированием