基于python的CFC滤波器实现（附源代码）

 

 

初学python欢迎各位大佬指正

参考文件 ISO6487 标准文件

ISO 6487: Road vehicles - Measurement techniques in impact tests - Instrumentation

滤波后

 

import math
'''这个算法基于ISO6487 
还有一些细节问题，所以仅供参考
切勿用于实际生产环境
'''
pi = 3.141592654 #派
samplerate = 0.0001  #采样频率 这个是采样间隔 就是1s除以10000
CFC  =  60   #滤波等级
wd = 1.25 * 2 * pi * CFC / 0.6
wa = math.atan(wd*samplerate/2)
b0 = math.pow(wa,2) / (1 + math.sqrt(2)*wa+math.pow(wa,2) )
b1 = 2*b0
b2 = b0
a1_1 = 1 - math.pow(wa,2)

a1_2 = 1 + math.sqrt(2)*wa+math.pow(wa,2)

a1 = 2 * a1_1 / a1_2

a2_1 = -1 +