我正在尝试将我的工作二阶巴特沃斯低通滤波器转换为 python 中的一阶,但它给了我非常大的数字,比如 flt_y_1st[299]: 26198491071387576370322954146679741443295686950912.0。这是我的二阶和一阶巴特沃斯:
import math
import numpy as np
import matplotlib.pyplot as plt
from scipy.signal import lfilter
from scipy.signal import butter
def butter_lowpass(cutoff, fs, order=1):
nyq = 0.5 * fs
normal_cutoff = cutoff / nyq
b, a = butter(order, normal_cutoff, btype='low', analog=False)
return b, a
def butter_lowpass_filter(data, cutoff, fs, order=1):
b, a = butter_lowpass(cutoff, fs, order=order)
y = lfilter(b, a, data)
return y
def bw_2nd(y, fc, fs):
filtered_y = np.zeros(len(y))
omega_c = math.tan(np.pi*fc/fs)
k1 = np.sqrt(2)*omega_c
k2 = omega_c**2
a0 = k2/(1+k1+k2)
a1 = 2*a0
a2 = a0
k3 = 2*a0/k2
b1 = -(-2*a0+k3)
b2 = -(1-2*a0-k3)
filtered_y[0] = y[0]
filtered_y[1] = y[1]
for i in range(2, len(y)):
filtered_y[i] = a0*y[i]+a1*y[i-1]+a2*y[i-2]-(b1*filtered_y[i-1]+b2*filtered_y[i-2])
return filtered_y
def bw_1st(y, fc, fs):
filtered_y = np.zeros(len(y))
omega_c = math.tan(np.pi*fc/fs)
k1 = np.sqrt(2)*omega_c
k2 = omega_c**2
a0 = k2/(1+k1+k2)
a1 = 2*a0
k3 = 2*a0/k2
b1 = -(-2*a0+k3)
# b1 = -(-2*a0) # <= Removing k3 makes better, but still not perfect
filtered_y[0] = y[0]
for i in range(1, len(y)):
filtered_y[i] = a0*y[i]+a1*y[i-1]-(b1*filtered_y[i-1])
return filtered_y
f = 100
fs = 2000
x = np.arange(300)
y = np.sin(2 * np.pi * f * x / fs)
flt_y_2nd = bw_2nd(y, 120, 2000)
flt_y_scipy = butter_lowpass_filter(y, 120, 2000, 1)
flt_y_1st = bw_1st(y, 120, 2000)
for i in x:
print('y[%d]: %6.3f flt_y_2nd[%d]: %6.3f flt_y_scipy[%d]: %6.3f flt_y_1st[%d]: %8.5f' % (i, y[i], i, flt_y_2nd[i], i, flt_y_scipy[i], i, flt_y_1st[i]))
plt.subplot(1, 1, 1)
plt.xlabel('Time [ms]')
plt.ylabel('Acceleration [g]')
lines = plt.plot(x, y, x, flt_y_2nd, x, flt_y_scipy, x, flt_y_1st)
l1, l2, l3, l4 = lines
plt.setp(l1, linewidth=1, color='g', linestyle='-')
plt.setp(l2, linewidth=1, color='b', linestyle='-')
plt.setp(l3, linewidth=1, color='y', linestyle='-')
plt.setp(l4, linewidth=1, color='r', linestyle='-')
plt.legend(["y", "flt_y_2nd", "flt_y_scipy", "flt_y_1st"])
plt.grid(True)
plt.xlim(0, 150)
plt.ylim(-1.5, 1.5)
plt.title('flt_y_2nd vs. flt_y_scipy vs. flt_y_1st')
plt.show()
...我删除了所有 [i-2],它们是前馈和反馈。
然而,这似乎还不够。我想我需要更改 a0、b1 等中的一些方程。例如,当我从 b1 中删除 '+k3' 时,我会得到这样的图(看起来更好,不是吗?):
我不是专门研究过滤器的,但至少我知道这个一阶不同于 scipy.butter 的一阶。所以,请帮我找到正确的系数。先感谢您。
这是我的参考:filtering_considerations.pdf