感謝各位的解答。目前問題暫時解決,用的是EWMA濾波公式
把得到的ADC都減去零點值,取他們的平恒值
/**********************************濾 波**********************************************/
float alpha = 0.9; // 初始濾波系數
float blpha = 0.9; // 初始第二次濾波系數
float min_alpha = 0.1; // 最小濾波系數
float min_blpha = 0.1; // 最小第二次濾波系數
float alpha_decay = 0.1; // 系數衰減步長
float blpha_decay = 0.1; // 第二次系數衰減步長
float filtered_value = 0, red_value = 0; // 初始化濾波值
float previous_value = 0; // 存儲上一個值,用于計算變化量
/************************************************************************/
// EWMA濾波公式
int process_integer_data(int new_value)
{
// 計算當前值與上一個值的差異
uint16_t change = fabs(new_value-previous_value);
previous_value = new_value;
// 動態調整濾波系數
if (change < 0.1) { // 假設小于0.01表示穩定
alpha = 0.09;
blpha = 0.09;
} else {
alpha = 0.8; // 可以增加一些系數以便于快速響應變化
blpha = 0.8;
}
// 應用濾波
filtered_value = alpha * new_value + (1 - alpha) * filtered_value;
red_value = blpha * filtered_value + (1 - blpha) * red_value;
return (int)(red_value + 0.5); // 返回濾波后的值
} |