описаниеисходникиИсходники правда на VHDL, но думаю идея будет ясна, тем более что алгоритмы работы описаны.
Обратите внимание на цифровой фильтр, который используется в указанных примерах! Частота его работы должна быть выше максимальной частоты импульсов энкодера минимум в два раза! Энкодер может выдать максимальную частоту например, если его вал неподвижен, стоит на границе дискреты, и начинает движение! Если рабочая частота вашего цифрового фильтра будет меньше заявленной максимальной частоты импульсов энкодера, то вы будете либо пропускать импульсы, либо насчитывать лишние.