1. 項目概述為什么我們需要這么多濾波算法在信號處理、圖像處理、嵌入式開發(fā)乃至數(shù)據(jù)分析的日常工作中“濾波”這個詞就像空氣一樣無處不在。你可能在調(diào)試一個傳感器讀數(shù)時發(fā)現(xiàn)數(shù)據(jù)跳得厲害想讓它“平滑”一點或者在處理一張老照片時希望去除惱人的噪點又或者在分析一段音頻時想提取出特定的頻率成分。所有這些需求的背后都指向同一個核心動作從混雜的信息中提取出我們真正關(guān)心的部分同時抑制或消除我們不想要的部分。這個核心動作就是濾波?！?0種濾波算法”這個標題乍一看像是一份枯燥的清單但它的價值在于提供了一個全景式的工具箱。沒有一種算法是“銀彈”能解決所有問題。不同的場景、不同的硬件資源、不同的實時性要求、不同的噪聲特性都決定了我們必須做出不同的選擇。比如在資源極其有限的單片機MCU上處理ADC采樣值你大概率不會去用計算量巨大的卡爾曼濾波而在進行高精度的導(dǎo)航定位時簡單的移動平均又顯得力不從心。因此掌握多種濾波算法并深刻理解它們各自的原理、適用場景和優(yōu)缺點是每一位工程師、開發(fā)者乃至數(shù)據(jù)分析師的基本功。這不僅能讓你在面對具體問題時快速選出最合適的“武器”更能讓你在方案設(shè)計階段就規(guī)避掉潛在的坑。接下來我將結(jié)合自己多年的實戰(zhàn)經(jīng)驗為你拆解這10種常見濾波算法的內(nèi)核從最基礎(chǔ)的到相對復(fù)雜的并附上它們最典型的應(yīng)用場景、實現(xiàn)要點以及那些只有踩過坑才知道的“潛規(guī)則”。2. 濾波算法核心思路與分類邏輯在深入每一種算法之前我們必須建立一個清晰的認知框架。濾波算法千變?nèi)f化但其核心目標無非是“去偽存真”。為了實現(xiàn)這個目標我們可以從幾個維度對它們進行分類這有助于我們快速定位。2.1 按處理域分類時域 vs 頻域這是最根本的分類。時域濾波直接對信號在時間序列上的幅值進行操作比如取平均、取中值。它的優(yōu)點是直觀、計算量相對小易于在嵌入式系統(tǒng)實現(xiàn)。我們后面要講到的大部分算法都屬于時域濾波如均值濾波、中值濾波、卡爾曼濾波等。頻域濾波則需要先將信號通過傅里葉變換轉(zhuǎn)換到頻率域在頻率域?qū)μ囟l段進行增強或抑制比如設(shè)計一個低通濾波器只允許低頻通過然后再變換回時域。它的優(yōu)勢在于設(shè)計靈活可以精確控制濾波器的頻率響應(yīng)特性比如巴特沃斯濾波器、切比雪夫濾波器。但計算復(fù)雜度高通常用在PC端或?qū)崟r性要求不高的后期處理中。2.2 按線性性質(zhì)分類線性 vs 非線性線性濾波滿足疊加性和齊次性輸出與輸入成線性關(guān)系。均值濾波、高斯濾波、以及大多數(shù)基于卷積的濾波器都是線性的。線性濾波理論成熟易于分析但對于脈沖噪聲極端的、突發(fā)的噪聲效果很差。非線性濾波則突破了線性限制。中值濾波就是經(jīng)典的非線性濾波它能有效濾除脈沖噪聲但可能會模糊信號的邊緣。還有形態(tài)學(xué)濾波等在處理圖像時非常有用。非線性濾波通常更“智能”但也更難以用統(tǒng)一的數(shù)學(xué)理論去描述其性能。2.3 按是否使用未來數(shù)據(jù)分類因果 vs 非因果因果濾波器也叫實時濾波器的輸出只依賴于當(dāng)前和過去的輸入不依賴未來的輸入。這在實時處理系統(tǒng)中是必須的比如正在飛行的無人機根據(jù)當(dāng)前和過去的傳感器數(shù)據(jù)估計狀態(tài)。移動平均、一階滯后濾波、卡爾曼濾波在預(yù)測步驟都是因果的。非因果濾波器可以使用未來的輸入數(shù)據(jù)。顯然這只能用于事后處理比如對已經(jīng)錄制完成的一段音頻或一張圖片進行降噪。在非實時場景下非因果濾波器通常能獲得更好的效果因為它擁有更全面的“信息”。2.4 按設(shè)計方法分類經(jīng)典 vs 現(xiàn)代經(jīng)典濾波算法通常基于直觀的統(tǒng)計或簡單的數(shù)學(xué)原理如均值、中值、滑動窗口。它們簡單粗暴在很多場合下非常有效?，F(xiàn)代濾波算法則建立在更嚴密的數(shù)學(xué)模型和最優(yōu)估計理論之上最著名的代表就是卡爾曼濾波和粒子濾波。它們不再把噪聲簡單視為需要去除的“壞東西”而是將其作為系統(tǒng)模型的一部分通過狀態(tài)空間模型動態(tài)地、最優(yōu)地在某種準則下如最小均方誤差估計出系統(tǒng)的真實狀態(tài)。這類算法功能強大但理解和實現(xiàn)門檻也更高。理解了這些分類我們就能明白所謂的“10種算法”其實是這個龐大工具箱中的一些經(jīng)典且實用的代表。下面我們就從最簡單、最常用的開始逐一拆解。3. 基礎(chǔ)與經(jīng)典五種必須掌握的時域濾波算法這五種算法是濾波世界的“基石”幾乎在任何領(lǐng)域都可能用到尤其是嵌入式開發(fā)和快速原型驗證階段。3.1 限幅濾波法程序判斷濾波法這可能是最簡單、最直接的濾波思想與其說是“濾波”不如說是“限幅”或“野值剔除”。核心原理根據(jù)經(jīng)驗或系統(tǒng)特性設(shè)定一個最大允許偏差值Δ。本次采樣值Y(n)與上次有效值Y(n-1)的差值若超過Δ則認為本次采樣是干擾野值舍棄并用上次值代替若未超過則認為本次采樣有效。偽代碼邏輯#define DELTA 10 // 最大允許偏差 int last_valid_value 0; int limit_filter(int current_sample) { if (abs(current_sample - last_valid_value) DELTA) { return last_valid_value; // 超出范圍返回舊值 } else { last_valid_value current_sample; // 更新有效值 return current_sample; } }適用場景適用于物理量變化緩慢的場合如溫度、液位等。對于快速變化的信號如加速度、聲音此法不適用因為正常變化也可能被誤判為噪聲。實操心得Δ的選取是關(guān)鍵。太小會導(dǎo)致信號僵化太大則失去濾波效果。通常需要結(jié)合信號正常變化速率和噪聲幅度來設(shè)定。這種方法只能濾除突發(fā)性的、幅值大的脈沖干擾對于小幅度的隨機噪聲無能為力。一個常見的變種是“限幅均值”組合連續(xù)多次超限后才判斷為干擾或者對未超限的樣本再取平均魯棒性更好。3.2 中值濾波法非線性濾波的典范在圖像處理中被稱為“去椒鹽噪聲的利器”。核心原理對一個滑動窗口內(nèi)的所有采樣值進行排序取其中間值中位數(shù)作為本次濾波輸出。它不依賴于平均值因此對極端值脈沖噪聲不敏感。窗口選擇窗口大小N通常取奇數(shù)3, 5, 7...方便直接取中間值。窗口越大濾波效果越強但信號延遲和計算量排序也越大。適用場景非常適合去除椒鹽噪聲即隨機出現(xiàn)的黑白點。在傳感器信號處理中常用于濾除偶發(fā)的、幅值很大的脈沖干擾。實操心得對于緩變信號中值濾波保邊效果優(yōu)于均值濾波。均值濾波會讓階躍信號的邊沿變緩而中值濾波能更好地保持邊沿的陡峭。計算效率是關(guān)鍵。對于嵌入式系統(tǒng)窗口不宜過大通常N3或5。排序算法可以選擇簡單的冒泡排序因為N很小。有一種優(yōu)化策略是維護一個有序的窗口每次滑動只局部調(diào)整可以降低計算復(fù)雜度。對于高斯白噪聲幅度符合正態(tài)分布的隨機噪聲中值濾波的效果不如均值濾波好。3.3 算術(shù)平均濾波法最樸素、最經(jīng)典的線性平滑方法。核心原理連續(xù)取N個采樣值進行算術(shù)平均。N值越大平滑度越高但靈敏度越低響應(yīng)變慢。Y(n) (X(n) X(n-1) ... X(n-N1)) / N適用場景適用于信號本身在某一數(shù)值范圍附近上下波動且噪聲為隨機白噪聲的場合。例如對直流電源電壓的測量、靜態(tài)稱重等。實操心得這是典型的非因果濾波器除非使用滑動窗口見下一條因為它需要集齊N個數(shù)據(jù)才能輸出一個結(jié)果會引入(N-1)/2個采樣點的固定延遲。在實時控制中需謹慎。為了實時輸出通常采用其變種——滑動平均濾波。它維護一個長度為N的隊列FIFO每次有新采樣進入就剔除最老的一個然后計算隊列中所有值的均值。這樣每個采樣周期都能輸出一個值但延遲依然存在。計算優(yōu)化無需每次求和再除以N?？梢跃S護一個隊列和Sum每次更新Sum Sum new_value - oldest_value輸出Sum / N。這避免了重復(fù)累加在MCU上非常高效。3.4 滑動加權(quán)平均濾波法算術(shù)平均濾波的“智能”升級版認為不同時刻的數(shù)據(jù)重要性不同。核心原理在滑動平均的基礎(chǔ)上為窗口內(nèi)的每個數(shù)據(jù)賦予一個權(quán)重系數(shù)。通常越新的數(shù)據(jù)權(quán)重越大越老的數(shù)據(jù)權(quán)重越小。加權(quán)和除以權(quán)重總和即為輸出。Y(n) (k0*X(n) k1*X(n-1) ... kN-1*X(n-N1)) / (k0k1...kN-1)權(quán)重設(shè)計這是算法的靈魂。常見的設(shè)計有線性遞減權(quán)重從新到老等差遞減。指數(shù)遞減權(quán)重按指數(shù)衰減對近期數(shù)據(jù)強調(diào)最多如k_i α^(i)(0α1)。當(dāng)窗口很大時可以近似為一種一階滯后濾波見下文。適用場景適用于需要兼顧實時性對新數(shù)據(jù)敏感和平滑性的場合。比單純的算術(shù)平均更能反映信號的近期變化趨勢。實操心得權(quán)重系數(shù)的和最好為1即歸一化可以省去除法運算直接計算加權(quán)和作為輸出。如何選擇權(quán)重分布需要根據(jù)信號和噪聲的特性來調(diào)試沒有固定公式更多是一種“藝術(shù)”?？梢酝ㄟ^觀察濾波后信號對階躍輸入的響應(yīng)來調(diào)整。3.5 一階滯后濾波法低通濾波在嵌入式領(lǐng)域應(yīng)用極其廣泛的一種遞歸濾波器計算量小效果直觀。核心原理它模擬了一個RC低通電路的行為。輸出是上次輸出值與本次輸入值的加權(quán)和。Y(n) α * X(n) (1-α) * Y(n-1)其中α為濾波系數(shù)0 α 1。α越大濾波器帶寬越寬對新數(shù)據(jù)的響應(yīng)越快但平滑效果越差α越小帶寬越窄平滑效果好但響應(yīng)遲鈍。頻率理解這個公式實現(xiàn)了一個一階低通濾波器。它允許低頻信號通過而衰減高頻噪聲。截止頻率fc與α和采樣周期Ts有關(guān)α ≈ 2π * fc * Ts當(dāng)α較小時。這是一個非常重要的關(guān)系式讓你能從頻率角度設(shè)計濾波器。適用場景適用于波動頻率較高的信號進行平滑如電源紋波、電機電流、某些加速度信號。是平衡實時性與平滑性的經(jīng)典選擇。實操心得與避坑指南初始化問題Y(0)如何設(shè)定如果設(shè)為0且系統(tǒng)初始值不為0濾波器需要很長時間才能“跟蹤”上真實信號。通常將Y(0)初始化為第一個采樣值X(0)。α 的選取這是核心參數(shù)。可以通過以下方式估算先確定你希望保留的信號最高頻率f_signal和希望濾除的噪聲最低頻率f_noise。截止頻率fc應(yīng)設(shè)在兩者之間。根據(jù)采樣頻率Fs 1/Ts計算歸一化截止頻率fc_norm fc / Fs。利用公式α 2π * fc_norm小α近似或更精確的公式α 1 - exp(-2π * fc_norm)計算。實際調(diào)試中往往是在線修改α觀察波形直到找到響應(yīng)速度和平滑度的最佳平衡點。一個經(jīng)驗起點是α 0.1~0.3。浮點與定點運算在無浮點單元的MCU上需要用定點數(shù)整數(shù)來運算。通常將α放大2^n倍如256倍用整數(shù)表示計算完后再右移n位。注意中間過程的數(shù)值范圍防止溢出。#define ALPHA 26 // 代表 α 26/256 ≈ 0.1 #define SHIFT 8 int32_t last_output 0; int16_t first_order_filter(int16_t input) { int32_t temp; temp (ALPHA * input) ((256 - ALPHA) * last_output); last_output temp SHIFT; // 除以256 return (int16_t)last_output; }缺點會產(chǎn)生相位滯后。對于需要嚴格保持相位關(guān)系的系統(tǒng)如某些控制系統(tǒng)需要考慮使用相位補償或更復(fù)雜的濾波器。4. 進階與優(yōu)化三種提升濾波性能的算法掌握了基礎(chǔ)算法后我們會發(fā)現(xiàn)它們各有局限。比如滑動平均對脈沖噪聲無力中值濾波對高斯噪聲一般一階滯后有延遲。下面這三種算法嘗試從不同角度進行優(yōu)化。4.1 中位值平均濾波法防脈沖干擾平均濾波法顧名思義它是中值濾波和平均濾波的“聯(lián)姻”旨在結(jié)合兩者優(yōu)點。核心原理連續(xù)采樣N個數(shù)據(jù)N通常較大如10-20先去掉其中的最大值和最小值可能為脈沖干擾然后對剩下的N-2個數(shù)據(jù)求算術(shù)平均。適用場景適用于同時存在隨機高斯噪聲和偶然的脈沖干擾的場合。典型應(yīng)用是工業(yè)現(xiàn)場慢變信號的采集如溫度、壓力既想平滑小波動又想剔除偶然的強干擾。實操心得這種方法計算量比單純平均大因為需要找最值。但相比全排序的中值濾波復(fù)雜度O(N log N)找最值復(fù)雜度O(N)并求和的代價還是小的。N的選取有講究。N太小剔除最值后樣本數(shù)太少平均效果差N太大延遲和計算量增加。通常取6~14之間的偶數(shù)這樣去掉兩個值后剩下的樣本數(shù)仍是偶數(shù)求平均無偏。這是一種非常實用且魯棒的算法在不少傳感器數(shù)據(jù)手冊的推薦處理算法中都能看到它的身影。4.2 遞推平均濾波法滑動平均濾波法在3.3節(jié)已簡要提及這里詳細展開其遞推遞歸實現(xiàn)這是其高效的核心。核心原理維護一個長度為N的隊列。每次新的采樣值X(n)進入隊列同時最老的采樣值X(n-N)移出隊列。濾波輸出Y(n)為當(dāng)前隊列中所有N個數(shù)據(jù)的平均值。Y(n) Y(n-1) (X(n) - X(n-N)) / N優(yōu)勢計算效率高無論窗口N多大每次更新只需要一次加法、一次減法和一次除法乘法計算復(fù)雜度為O(1)。而普通的非遞推平均每次都需要對N個數(shù)求和復(fù)雜度O(N)。適用場景任何需要固定窗口大小進行實時平均的場合。是嵌入式系統(tǒng)中實現(xiàn)低通濾波最常用的方法之一尤其當(dāng)N較大時效率優(yōu)勢明顯。實操心得與避坑指南隊列實現(xiàn)在C語言中通常用數(shù)組配合頭尾指針或索引來實現(xiàn)循環(huán)隊列。確保隊列操作正確是第一步。數(shù)值精度Y(n-1)是上次的平均值用浮點數(shù)表示沒問題。但在定點MCU上(X(n) - X(n-N)) / N這個除法可能產(chǎn)生舍入誤差。長期運行誤差可能會累積導(dǎo)致輸出漂移。一種改進方法是維護一個整數(shù)型的隊列和Sum見3.3心得輸出時再做除法精度更高。延遲分析該濾波器會引入(N-1)/2個采樣周期的群延遲。這意味著輸出波形在時間上比輸入波形整體向后平移了這么多。在控制環(huán)路中這個延遲必須被考慮進去因為它會影響系統(tǒng)的相位裕度甚至導(dǎo)致不穩(wěn)定。4.3 加權(quán)遞推平均濾波法遞推平均的加權(quán)版本同樣可以采用遞推形式高效計算。核心原理在加權(quán)平均的基礎(chǔ)上如果權(quán)重系數(shù)選擇指數(shù)衰減形式k_i α * (1-α)^i那么可以推導(dǎo)出驚人的結(jié)果它的遞推形式就是一階滯后濾波Y(n) α * X(n) (1-α) * Y(n-1)看是不是和3.5節(jié)的公式一模一樣這說明一階滯后濾波本質(zhì)上是一個具有無限長記憶、但權(quán)重指數(shù)衰減的加權(quán)遞推平均濾波器。老的樣本不是被移出窗口而是其權(quán)重逐漸衰減至可忽略不計。深度理解這個視角非常有用。它解釋了為什么一階滯后濾波沒有固定的“窗口大小”但其“有效記憶長度”可以用時間常數(shù)τ Ts / α來衡量。經(jīng)過約3τ-5τ的時間一個階躍輸入的影響才會基本體現(xiàn)在輸出上。適用場景同一階滯后濾波。但它為我們提供了另一種設(shè)計思路如果你想要一個“軟”窗口即越老的數(shù)據(jù)影響力越弱而不是被突然截斷那么一階滯后指數(shù)加權(quán)是天然的選擇。實操心得當(dāng)需要更復(fù)雜的頻率響應(yīng)時如更陡的滾降可以將多個一階滯后濾波器串聯(lián)形成二階、三階低通濾波。但要注意階數(shù)越高相位滯后越嚴重。還有一種“雙重加權(quán)”思路例如先對信號進行加權(quán)遞推平均再對結(jié)果進行第二次加權(quán)處理用于特定需求但計算和調(diào)試更復(fù)雜。5. 現(xiàn)代與智能兩種基于模型的先進估計算法當(dāng)系統(tǒng)動態(tài)模型已知且對估計精度要求極高時經(jīng)典濾波方法就顯得力不從心了。這時需要請出基于最優(yōu)估計理論的“大神級”算法。5.1 卡爾曼濾波毫無疑問這是最著名、應(yīng)用最廣泛的現(xiàn)代濾波算法從阿波羅登月到現(xiàn)在的自動駕駛、無人機、手機導(dǎo)航無處不在。核心思想卡爾曼濾波不再簡單地將噪聲濾除而是將它納入一個動態(tài)系統(tǒng)模型中。它假設(shè)系統(tǒng)狀態(tài)隨時間以某種方式演化狀態(tài)方程并且我們能通過傳感器得到帶有噪聲的觀測觀測方程?？柭鼮V波通過“預(yù)測-更新”兩個步驟遞歸地、最優(yōu)地在最小均方誤差意義下融合模型預(yù)測和實際觀測給出系統(tǒng)狀態(tài)的最佳估計。核心公式簡化概念版預(yù)測基于上一時刻的最優(yōu)估計和系統(tǒng)模型預(yù)測當(dāng)前時刻的狀態(tài)和不確定性。X_pred F * X_est B * uP_pred F * P_est * F^T Q更新校正拿到當(dāng)前時刻的傳感器測量值Z。計算卡爾曼增益KK P_pred * H^T * (H * P_pred * H^T R)^-1。K決定了我們是更相信預(yù)測還是更相信觀測。用觀測值校正預(yù)測值X_est X_pred K * (Z - H * X_pred)。這就是融合更新估計的不確定性P_est (I - K * H) * P_pred。 其中F是狀態(tài)轉(zhuǎn)移矩陣H是觀測矩陣Q是過程噪聲協(xié)方差模型信任度R是觀測噪聲協(xié)方差傳感器信任度P是估計誤差協(xié)方差。適用場景導(dǎo)航與定位融合IMU慣性測量單元數(shù)據(jù)高頻、但會漂移和GPS數(shù)據(jù)低頻、但絕對準確得到平滑、準確、高頻的位置/姿態(tài)估計。這是經(jīng)典應(yīng)用。傳感器融合融合多個同類或異類傳感器的數(shù)據(jù)得到更可靠的狀態(tài)估計。如融合攝像頭和雷達的目標跟蹤。控制系統(tǒng)作為狀態(tài)觀測器估計無法直接測量的系統(tǒng)狀態(tài)如電機轉(zhuǎn)速、電池SOC。實操心得與巨大挑戰(zhàn)模型是靈魂卡爾曼濾波的性能極度依賴于你建立的系統(tǒng)模型F, B, H矩陣是否準確。如果模型與實際物理過程相差甚遠結(jié)果可能還不如簡單濾波。調(diào)參是藝術(shù)噪聲協(xié)方差矩陣Q和R是關(guān)鍵的調(diào)節(jié)參數(shù)。Q大表示你認為模型不可靠濾波會更依賴觀測R大表示你認為傳感器噪聲大濾波會更依賴模型預(yù)測。調(diào)整這兩個參數(shù)是使卡爾曼濾波工作的關(guān)鍵通常需要結(jié)合經(jīng)驗和對系統(tǒng)的理解。非線性擴展標準卡爾曼濾波只適用于線性系統(tǒng)。對于非線性系統(tǒng)現(xiàn)實中大部分都是需要使用擴展卡爾曼濾波EKF或無跡卡爾曼濾波UKF。EKF通過對非線性函數(shù)進行一階泰勒展開來近似實現(xiàn)簡單但可能在強非線性下發(fā)散。UKF采用一種確定的采樣點方法來近似非線性分布精度更高計算量也更大。不要神化卡爾曼濾波不是魔法。對于模型未知、噪聲特性不明的簡單系統(tǒng)用一階滯后或滑動平均可能更簡單有效。它的強大體現(xiàn)在對有良好模型的動態(tài)系統(tǒng)進行最優(yōu)估計。5.2 粒子濾波當(dāng)系統(tǒng)非線性、非高斯特性非常強連EKF和UKF都難以處理時粒子濾波提供了另一種強大的思路。核心思想一種基于蒙特卡洛方法的序列重要性采樣算法。它不像卡爾曼濾波那樣用均值和方差來描述狀態(tài)分布而是用一堆隨機樣本稱為“粒子”來直接表示概率分布。每個粒子代表系統(tǒng)狀態(tài)的一種可能情況并有一個權(quán)重表示其可能性大小。隨著新的觀測數(shù)據(jù)到來算法通過“重采樣”過程讓權(quán)重大的粒子繁殖權(quán)重小的粒子消亡從而讓粒子群逐漸聚集到真實狀態(tài)的高概率區(qū)域。工作流程初始化根據(jù)先驗分布生成一群隨機粒子。預(yù)測根據(jù)系統(tǒng)模型讓每個粒子向前“運動”傳播模擬狀態(tài)隨時間的演化。這一步會引入過程噪聲。更新獲得新的觀測數(shù)據(jù)后計算每個粒子的權(quán)重。權(quán)重正比于“在當(dāng)前觀測下該粒子所代表的狀態(tài)出現(xiàn)的可能性”?？赡苄栽礁邫?quán)重越大。重采樣根據(jù)權(quán)重從當(dāng)前的粒子集合中有放回地抽取新的粒子集合。權(quán)重高的粒子更可能被多次抽中權(quán)重低的粒子可能被淘汰。新的粒子集合所有粒子權(quán)重重置為相等。狀態(tài)估計通常用所有粒子的狀態(tài)加權(quán)平均或直接取粒子作為當(dāng)前時刻的狀態(tài)估計。適用場景非線性和非高斯性極強的系統(tǒng)例如機器人定位同時定位與地圖構(gòu)建SLAM、金融時間序列分析、目標跟蹤在雜波環(huán)境中。多模態(tài)分布當(dāng)系統(tǒng)狀態(tài)可能存在多個可能性相近的“峰值”時比如機器人可能在走廊的A點或B點卡爾曼濾波它假設(shè)單峰高斯分布會失效而粒子濾波可以很好地表示這種多模態(tài)分布。實操心得與局限性計算量巨大這是粒子濾波最致命的缺點。為了準確描述分布可能需要成千上萬個粒子每個粒子都要獨立進行模型傳播和權(quán)重計算計算開銷遠大于卡爾曼濾波家族。這限制了它在實時性要求高的嵌入式系統(tǒng)中的應(yīng)用。粒子退化與耗盡經(jīng)過幾次迭代后可能只有少數(shù)粒子擁有高權(quán)重其他粒子權(quán)重近乎為零。這導(dǎo)致大量的計算浪費在無效粒子上稱為“退化”。重采樣雖然可以緩解但會導(dǎo)致“耗盡”問題即多樣性喪失所有粒子都來源于少數(shù)幾個祖先粒子無法探索狀態(tài)空間的其他區(qū)域。建議對于大多數(shù)工程問題首先考慮卡爾曼濾波或其非線性變種EKF, UKF。只有當(dāng)系統(tǒng)非線性、非高斯特性非常明顯且你有充足的計算資源時才考慮粒子濾波。同時有很多改進算法如正則化粒子濾波、輔助粒子濾波等可以用來緩解退化和耗盡問題。6. 算法選型實戰(zhàn)指南與避坑總結(jié)面對具體問題如何從這10種乃至更多算法中做出選擇下面這張對比表可以給你一個快速的參考算法名稱核心原理優(yōu)點缺點適用場景計算復(fù)雜度實時性限幅濾波超閾值判斷極其簡單能剔除野值對隨機噪聲無效參數(shù)Δ敏感慢變信號防突發(fā)脈沖O(1)實時中值濾波取窗口樣本中位數(shù)有效去除脈沖噪聲保邊性好對高斯噪聲一般窗口大時計算量增加圖像椒鹽噪聲傳感器脈沖干擾O(N log N) 或 O(N) (優(yōu)化后)實時窗口小算術(shù)平均求N個樣本均值平滑隨機噪聲效果好引入固定延遲削弱突變信號靜態(tài)或緩變信號抑制白噪聲O(N)非實時/批處理滑動平均遞推求窗口均值實時輸出計算高效(O(1))仍有群延遲對脈沖噪聲敏感實時平滑嵌入式低通O(1)實時加權(quán)平均按權(quán)重求均值可強調(diào)近期數(shù)據(jù)更靈活權(quán)重設(shè)計需調(diào)試無統(tǒng)一標準需平衡新舊數(shù)據(jù)重要性的場景O(N)通常非實時一階滯后指數(shù)加權(quán)遞歸計算簡單無固定窗口相位滯后固定對脈沖噪聲敏感僅一階滾降慢通用低通平衡響應(yīng)與平滑O(1)實時中位值平均去頭尾后平均兼顧脈沖噪聲和白噪聲計算量比平均大需排序找最值工業(yè)現(xiàn)場慢變信號采集O(N)通常非實時卡爾曼濾波模型預(yù)測觀測更新最優(yōu)估計可融合多源數(shù)據(jù)理論優(yōu)美需精確模型調(diào)參復(fù)雜對非線性需擴展導(dǎo)航、定位、傳感器融合、狀態(tài)估計O(n^3) (矩陣求逆)實時模型簡單時粒子濾波蒙特卡洛采樣處理強非線性、非高斯問題理論框架通用計算量巨大存在粒子退化問題SLAM、復(fù)雜目標跟蹤、金融分析O(M) (M為粒子數(shù)很大)通常非實時選型決策流程建議分析信號與噪聲特性首先搞清楚你要處理的信號變化快慢頻率、噪聲是什么類型高斯白噪聲、周期性工頻干擾、隨機脈沖、信噪比大致如何。明確系統(tǒng)約束你的處理平臺是什么MCU算力如何內(nèi)存多大必須是實時處理嗎允許的延遲是多少確定核心需求最關(guān)心平滑度還是響應(yīng)速度是要濾除特定頻率噪聲還是只要整體平滑是否需要保持信號邊緣如圖像從簡單到復(fù)雜嘗試第一步試試滑動平均或一階滯后。它們實現(xiàn)簡單在大多數(shù)要求“平滑一下”的場合都能起到不錯的效果。通過調(diào)整窗口大小N或濾波系數(shù)α來平衡效果。第二步如果發(fā)現(xiàn)數(shù)據(jù)中有明顯的“毛刺”脈沖加入中值濾波或限幅濾波進行預(yù)處理?？梢圆捎谩爸兄灯骄被颉跋薹鶞蟆钡募壜?lián)方式。第三步如果信號和噪聲在頻域上有明顯區(qū)分可以考慮在PC上設(shè)計數(shù)字濾波器如FIR、IIR進行后處理或者將設(shè)計好的濾波器系數(shù)移植到嵌入式端。第四步如果你的系統(tǒng)有明確的物理模型比如運動模型并且對估計精度要求極高需要融合多個傳感器數(shù)據(jù)那么是時候深入學(xué)習(xí)并應(yīng)用卡爾曼濾波了。第五步只有當(dāng)你面對極度非線性、非高斯的復(fù)雜估計問題且算力充足時才考慮粒子濾波。避坑總結(jié)與黃金法則沒有免費的午餐任何濾波都會以犧牲某些特性如延遲、相位、計算量為代價來換取其他特性如平滑度、去噪能力。明確你的主要矛盾和可接受的代價。參數(shù)調(diào)試是必須的幾乎所有算法都有關(guān)鍵參數(shù)窗口大小N、系數(shù)α、噪聲協(xié)方差Q/R等。不要指望有放之四海而皆準的默認值。必須結(jié)合你的實際信號通過觀察濾波前后的波形時域和頻域來反復(fù)調(diào)整。警惕延遲在閉環(huán)控制系統(tǒng)中濾波器的相位延遲或群延遲可能嚴重影響系統(tǒng)穩(wěn)定性。務(wù)必分析或測量所用濾波器的延遲特性并在控制器設(shè)計中予以考慮或補償。初始化很重要對于遞歸濾波器如一階滯后、卡爾曼濾波初始狀態(tài)的設(shè)定會影響收斂速度。一個好的實踐是用前幾個采樣值的均值或第一個采樣值進行初始化。定點數(shù)運算陷阱在嵌入式設(shè)備上使用整數(shù)運算時特別注意濾波系數(shù)縮放后的精度、運算過程中的溢出問題。多使用int32_t做中間運算避免int16_t直接相乘后溢出。組合使用單一濾波器往往難以解決所有問題。不要害怕將多個簡單濾波器組合使用例如先中值去脈沖再低通平滑往往能取得比單一復(fù)雜濾波器更好的效果。濾波既是一門科學(xué)也是一門藝術(shù)。科學(xué)在于其背后的數(shù)學(xué)原理藝術(shù)在于根據(jù)實際問題靈活選擇和調(diào)整。希望這10種算法的深度拆解能為你提供一個堅實的工具箱和清晰的選型地圖。記住最好的濾波算法永遠是那個最能解決你當(dāng)下具體問題、同時滿足資源約束的算法。動手實驗觀察數(shù)據(jù)不斷調(diào)整你就能成為駕馭數(shù)據(jù)噪聲的專家。