|
Считаем что: х - это вход, y - это выход, z0 и z1 в начале равны 0.
Тогда каждые 250 мкс последовательно расчитываем:
u3=z1-z0
u4=A*u3
u5=z1+u4
u1=x-u5
u2=K*u1
y=u5+u2-x
и обновляем значения z0 и z1
z0=u2
z1=u5-u3
Здесь A=0.7853, а K=1+1/32 для полосы 20 Гц при центральной 425 или K=1+1/16 для полосы 40 Гц по критерию -3 Дб.
Когда на входе максимум за 20-40 отсчетов не будет отличаться более чем в 1.25 раза от максимума на выходе можете считать, что принимаете тональный сигнал.
E-mail: info@telesys.ru