Рад за Вас. Настройки сложноваты конечно для восприятия с первого раза. Это особенности ВСЕХ универсальных устройств. Если есть желание и возможности попробуйте переходить на свободно программируемые устройства. ПР 200 например. Ваш алгоритм там решается на раз. Ещё и добавить можно много чего.
Правда тут конечно тоже есть свои ограничения. Относительно Вашей задачи например, алгоритм сделать легко, но существуют ограничения по входной частоте. Не больше 200Гц. У СИ 20 конечно гораздо больше.
Вот как то так.
С уважением.