Для контроля направления вращения можно использовать бит3 и бит4 слова состояния ST06:
Бит3 устанавливается в 1 при значении переменной RFR (частота двигателя) более 0.2 Гц при движении вперед.
Бит4 устанавливается в 1 при значении переменной RFR (частота двигателя) более 0.2 Гц при движении назад.
ST06 | Status registers 6 | 16#3EEA = 16106 |
Bit 3 | (MFRD) : Motor running in Forward |
Bit 4 | (MRRS) : Motor running in Reverse |
Бит3 устанавливается в 1 при значении переменной RFR (частота двигателя) более 0.2 Гц при движении вперед.
Бит4 устанавливается в 1 при значении переменной RFR (частота двигателя) более 0.2 Гц при движении назад.