Скорректировал измеритель частоты.
Сделал его с учетом фильтра и еще скорректировал запись во внутреннию память что улучшило точность
Более менее работает. Но вроле теперь открылась проблема с начальной фазой при демодуляции