CoDeSys 3.5 и расчёт скорости по сигналу от энкодера

Доброго времени суток. Имеется ПЛК с CoDeSys 3.5 и модулем счета импульсов, а так же энкодер с 1024 имульсов на оборот на валу двигателя. Модуль счета позволяет точно снимать количество импульсов на один оборот вала, но еще необходимо рассчитать скорость вращения в об\мин. Для этого была создана отдельная задача с циклом в 20 мс где в начале и конце цикла берется значение от энкодера и считается разница между ними, далее по этой разнице за 20 мс вычисляется скорость в об\мин. Вроде все правильно, но присутствуют значительные скачки в рассчитанном значении скорости из-за резких изменений переменной разницы в начале и конце цикла. Никто не подскажет как избавиться от этих скачков или существует альтернативный способ отследить изменение переменной за промежуток времени? С использованием ФБ D_trig ситуация аналогичная. Скриншоты прилагаю