Сдвоенный энкодер

Материал из roboforum.ru Wiki
Версия от 06:24, 5 июля 2011; Denis Linvinus (обсуждение | вклад) (Однократная точность)
Перейти к: навигация, поиск

Англ. - Quadrature encoder или Q-encoder

Диск сдвоенного энкодера

Разновидность инкрементального энкодера, которая состоит из двух датчиков срабатывающих со смещением в полшага, что позволяет практически полностью гарантировать отсутствие ложных срабатываний на границе одного из энкодеров. Кроме того, этот вариант позволяет контролировать не только длину, но и направление перемещения.


Т.е. если первый из энкодеров меняет своё состояние с A на B и при этом второй энкодер в состоянии C, тогда направление вычисляется функцией dir=A xor C или если короче dir=A^C.


Иногда в таком энкодере вводят дополнительный канал включающийся 1 раз за полный поворот, чтобы обеспечить еще большую защиту от ошибок подсчета даже при длительной эксплуатации и обеспечить определение точного положения вала при хотя-бы одном произведенном полном обороте.


Дополнение:

Сигнал с энкодера Состояния выходов A и B:

Код Грея для
вращения по часовой стрелке
Фаза A B
1 0 0
2 0 1
3 1 1
4 1 0
Код Грея для
вращения против часовой стрелки
Фаза A B
1 1 0
2 1 1
3 0 1
4 0 0
Сигнал с квадратурного энкодера (вращение по часовой стрелке).

Измерение сигнала с энкодера

Первым делом нужно подключить энкодер к контроллеру.

Выходы энкодера

Обычно энкодер имеет выходы A,B, питание, земля, и (возможно) сигнал полного оборота.

Сигнал полного оборота появляется один раз за один оборот, и может использоваться для подсчёта количества оборотов, или расчёта точного положение относительно начала оборота.


Для определения положения вала энкодера, используют счётчики сигналов A,B.

Как правило счётчик увеличивается если направление по часовой стрелке и уменьшается если направление против часовой стрелки.


Существует три способа измерения данных с выхода энкодера.

Они отличаются точностью измерения и нагрузкой на контроллер.

Однократная точность

Один из каналов энкодера (пусть будет A) подключается к внешнему прерыванию контроллера, второй канал (B) подключается на обычный цифровой вход.

Настаивается прерывание по фронту канала А.

Измерение проводят только по фронту канала A,

при этом сравнивается состояние вывода B, если на канале B низкий уровень то вращение против часовой стрелки.

Если на канале B высокий уровень то вращение по часовой стрелки.

Однократная точность

Такой способ измерения использует только четверть данных с энкодера, зато минимизирует нагрузку на контроллер, достаточно проверить состояние канала B.

Этот способ будет показывать одно и тоже направление, даже если будут пропуски импульсов от энкодера, например в случае если программа не будет успевать обрабатывать прерывания.

Естественно потерянные импульсы ничем не заменить.

Например если настроить прерывание по фронту для сигнала A то работать будет так:

Код Грея для
вращения по часовой стрелке
и алгоритм в действии
Фаза A B операция сравнения B
1 0 0 -
2 0 1 -
3 1 1 B равно 1
4 1 0 -
Код Грея для
вращения против часовой стрелки
и алгоритм в действии
Фаза A B операция сравнения B
1 1 0 B равно 0
2 1 1 -
3 0 1 -
4 0 0 -

Но так же, для проверки направления, можно выполнить операцию Xor для A и B, см пример для двукратной точности.

Двукратная точность

Один из каналов энкодера (пусть будет A) подключается к внешнему прерыванию контроллера, второй канал (B) подключается на обычный цифровой вход.

Настаивается прерывание по фронту и спаду канала А.

Измерение проводят только по фронту и спаду канала A,

при этом сравнивается состояние вывода B и учитывается какое именно прерывание произошло по фронту или по спаду,

Если на канале B низкий уровень и прерывание на А по фронту, или если на канале B высокий уровень и прерывание на А по спаду, то вращение против часовой стрелке.

Если на канале B высокий уровень и прерывание на А по фронту, или если на канале B низкий уровень и прерывание на А по спаду, то вращение по часовой стрелке.

Двукратная точность

Такой способ измерения использует половину данных с энкодера.

Для проверки направления достаточно выполнить операцию Xor ( A ^ B ).

Например если настроить прерывание по фронту и спаду для сигнала B то работать будет так:

Код Грея для
вращения по часовой стрелке
и алгоритм в действии
Фаза A B операция xor
1 0 0 состояние B не изменилось
2 0 1 0 ^ 1 = 1
3 1 1 состояние B не изменилось
4 1 0 1 ^ 0 = 1
Код Грея для
вращения против часовой стрелки
и алгоритм в действии
Фаза A B операция xor
1 1 0 состояние B не изменилось
2 1 1 1 ^ 1 = 0
3 0 1 состояние B не изменилось
4 0 0 0 ^ 0 = 0

Четырёхкратная (максимальная) точность

Оба канала подключаются к выводам для внешних прерываний контроллера и настраиваются прерывания по фронту и спаду на оба канала.

Максимальная точность

Такой способ измерения использует все данные с энкодера, и требует чтобы контроллер помнил состояние А и B с момента предыдущего прерывания.

Так же стоит отметить, что в отличие от двух предыдущих методов, в случае пропуска импульсов от энкодера, возможны ошибки направления!

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

Между соседними состояниями всегда изменяется только один бит.

Хороший и простой алгоритм предложил Scott Edwards, in Nuts&Volts Vol 1 Oct. 1995 [[1]]

Если применить операцию "исключающее или" для двух любых последовательностей, то сравнивая правый бит предыдущего состояния с левым битом нового состояния всегда даст 1 в случае если последовательность от вращения по часовой стрелки и 0 в случае вращения против часовой стрелки.

Например:

Код Грея для
вращения по часовой стрелке
и алгоритм в действии
Фаза A B операция xor
1 0 0 1(0) ^ (0)0 =0
2 0 1 0(0) ^ (0)1 =0
3 1 1 0(1) ^ (1)1 =0
4 1 0 1(1) ^ (1)0 =0
Код Грея для
вращения против часовой стрелки
и алгоритм в действии
Фаза A B операция xor
1 1 0 0(0) ^ (1)0 = 1
2 1 1 1(0) ^ (1)1 = 1
3 0 1 1(1) ^ (0)1 = 1
4 0 0 0(1) ^ (0)0 = 1

В скобках биты над которыми производится операция xor для вычисления направления.

Ссылки

http://en.wikipedia.org/wiki/Rotary_encoder

http://forum.pololu.com/viewtopic.php?t=484

http://zone.ni.com/devzone/cda/tut/p/id/7109