參考模電RC濾波計算公式來計算截止頻率

#define M_PI_FLOAT 3.14159265358979323846ftypedef struct LpfFilter {float RC;//模電RC濾波的電阻和電容值的積float dT;//數據更新時間隔（秒）float k;//濾波系數float state;//濾波結果 }LpfFilter_t;/**設置濾波的截止頻率 * *filter： * f_cut：截止頻率 * dt: 數據更新時間隔（秒） */ void filterInit(LpfFilter_t *filter, float f_cut, float dt) {filter->RC = 1.0f / ( 2.0f * M_PI_FLOAT * f_cut);//參考模電RC截止頻率公式filter->dT = dT;//數據更新時間隔（秒）filter->k = filter->dT / (filter->RC + filter->dT);//濾波系數 }/**應用低通濾波 * *filter： * input：新輸入數據 */ float LpfFilterApply(pt1Filter_t *filter, float input) {//dt固定時，截止頻率越低，k越小，數據最終輸出的變化越慢（高頻去掉了）//截止頻率固定時，dT越大，k越小，數據最終輸出的變化越慢（高頻去掉了）filter->state = filter->state + filter->k * (input - filter->state);return filter->state; }

參考：

https://github.com/betaflight/betaflight/blob/master/src/main/common/filter.c

總結

以上是生活随笔為你收集整理的数字低通滤波算法及截止频率计算，pt1Filter，lpf的全部內容，希望文章能夠幫你解決所遇到的問題。

如果覺得生活随笔網站內容還不錯，歡迎將生活随笔推薦給好友。