花玉,王娜,b,趙克友
(青島大學(xué) a. 自動化學(xué)院;b. 山東省工業(yè)控制技術(shù)重點(diǎn)實(shí)驗(yàn)室, 山東 青島 266071)
當(dāng)系統(tǒng)存在過程噪聲和測量噪聲的情況下,傳統(tǒng)卡爾曼濾波器[1]能遞歸估計(jì)線性系統(tǒng)狀態(tài),但是其要求干擾噪聲必須是高斯白噪聲。因?yàn)橄到y(tǒng)的不確定干擾可能不是白噪聲,且某些輸入無法測量,因此卡爾曼濾波器的效果有時并不理想。
在系統(tǒng)分析中,未知輸入可以表示無法測量的干擾、未建模動態(tài)、系統(tǒng)故障等。因此,研究含有未知輸入的系統(tǒng)估計(jì)問題具有極大意義。這類問題的解決方案在控制系統(tǒng)設(shè)計(jì)中的干擾抑制[2-3]、故障檢測[4]、電池狀態(tài)估計(jì)[5]等許多實(shí)際應(yīng)用中發(fā)揮重要作用。
近年來,存在未知輸入的濾波器設(shè)計(jì)問題引起了相當(dāng)大的關(guān)注。根據(jù)系統(tǒng)不同,該問題可大致分為兩類:帶有直通項(xiàng)的濾波器設(shè)計(jì)[6-12]和不帶直通項(xiàng)的濾波器設(shè)計(jì)[13-17],其中關(guān)于不帶直通項(xiàng)的濾波器設(shè)計(jì)文獻(xiàn)相對較少,具有進(jìn)一步研究的價值。
最初,解決這類問題的方法是系統(tǒng)狀態(tài)擴(kuò)維,將未知輸入向量作為系統(tǒng)狀態(tài)的附加部分,然后對擴(kuò)維系統(tǒng)應(yīng)用卡爾曼濾波器。這種方法通常將未知輸入假定為常值偏差或某些具有已知統(tǒng)計(jì)特性的隨機(jī)過程[18],但這些假設(shè)在實(shí)際應(yīng)用中可能是無效的。因此,許多研究開始轉(zhuǎn)向存在任意未知輸入情況下的系統(tǒng)狀態(tài)估計(jì)問題。解決此類問題的方法通常是通過解耦來實(shí)現(xiàn)狀態(tài)估計(jì)。
自從KITANIDIS P K開展工作以來,對未知輸入估計(jì)問題的研究開始轉(zhuǎn)向最優(yōu)濾波器,其為不帶直通項(xiàng)的線性系統(tǒng),開發(fā)了一種最小方差無偏(minimum variance unbiased, MVU)的最優(yōu)濾波器[13]。該濾波器通過在無偏條件的約束下將狀態(tài)協(xié)方差矩陣的跡最小化以獲得狀態(tài)估計(jì)。該濾波器被文獻(xiàn)[14]進(jìn)一步擴(kuò)展為一類參數(shù)化解決方案。上述文獻(xiàn)雖然解決了存在未知輸入時的狀態(tài)估計(jì)問題,但沒有給出未知輸入的估計(jì)值。對一些實(shí)際問題來說,未知輸入的估計(jì)值同樣重要。文獻(xiàn)[16]提出一種魯棒兩段卡爾曼濾波器(robust two-stage kalman filter,RTSKF),首先識別初始時刻未知輸入的動態(tài)模型,然后用識別的模型對未知輸入和狀態(tài)進(jìn)行估計(jì),其能夠給出未知輸入的具體估計(jì)值,但沒有證明所得結(jié)果最優(yōu)。文獻(xiàn)[17]提出一種三步迭代濾波器(recursive three-step filter, RTSF),能夠同時獲得系統(tǒng)狀態(tài)和未知輸入的最小方差無偏估計(jì),并證明了未知輸入估計(jì)值最優(yōu)。盡管上述濾波器可以解決存在未知輸入下系統(tǒng)狀態(tài)及未知輸入的估計(jì)問題,但都有一個前提條件:系統(tǒng)狀態(tài)方程中未知輸入的系數(shù)矩陣列滿秩。
本文基于RTSF思路,提出一種新型三步迭代濾波器(novel recursive three-step filter,NRTSF),在系統(tǒng)狀態(tài)方程受未知輸入影響時估計(jì)系統(tǒng)狀態(tài)和未知輸入,該濾波器不需要系統(tǒng)方程中未知輸入系數(shù)矩陣列滿秩,其應(yīng)用條件比上述濾波器寬松。
考慮如下帶有未知輸入的隨機(jī)線性離散時變系統(tǒng):
xk=Ak-1xk-1+Gk-1dk-1+wk-1
(1)
yk=Ckxk+vk
(2)
GILLIJNS S在文獻(xiàn)[17]中提出的經(jīng)典RTSF可以解決上述系統(tǒng)的狀態(tài)估計(jì)問題,但是使用RTSF的前提條件是系統(tǒng)方程中未知輸入的系數(shù)矩陣Gk-1必須滿足rank(Gk-1)=m,k=1,2,…。針對系統(tǒng)方程中未知輸入系數(shù)矩陣不滿秩的情況,即rank(Gk-1)=rk 假如rank(Gk-1)=rk≤m,對其進(jìn)行如下滿秩矩陣分解: (3) 換言之,存在非奇異陣Dk∈Rp×p和Fk∈Rm×m,使 (4) 則原系統(tǒng)方程式(1)改寫為 (5) 基于新的系統(tǒng)狀態(tài)方程式(5)和測量方程式(2)設(shè)計(jì)NRTSF如下: (6) (7) (8) 1)虛擬未知輸入的無偏估計(jì) (9) 其中 (10) 證明: 該證明與文獻(xiàn)[17]中定理1的證明相似,因此省略。 由于對應(yīng)于式(9)的最小二乘解滿足定理1,因此這個最小二乘解無偏。但根據(jù)Gauss-Markov定理,它不一定是最小方差解,因?yàn)樵谝话闱闆r下 其中c表示正實(shí)數(shù)。 2)虛擬未知輸入的MVU估計(jì) 證明: 該證明與文獻(xiàn)[17]中定理2的證明相似,因此省略。 (11) (12) (13) (14) 證明:使用拉格朗日乘子法來證明此定理。令拉格朗日式 (15) (16) 式(16)和式(12)組成線性系統(tǒng)方程組 (17) 將式(14)代入式(8)產(chǎn)生等效狀態(tài)更新: 將式(14)代入式(13)可得 將NRTSF總結(jié)如下: 1)時間更新 2)虛擬未知輸入估計(jì) 3)測量更新 為了驗(yàn)證本文提出的NRTSF有效性,本節(jié)采用與杜濤[19]一致的示例進(jìn)行仿真。 假設(shè)線性系統(tǒng)的相關(guān)矩陣如下: 圖1 未知輸入dk的實(shí)際值 圖2是應(yīng)用NRTSF得到的未知輸入估計(jì)結(jié)果圖。從中可以看出NRTSF能夠估計(jì)未知輸入d1k、d2k,但是對未知輸入d3k沒有估計(jì)效果,造成這一現(xiàn)象的原因是系數(shù)矩陣GK不滿秩。因此未知輸入d3k沒有影響到系統(tǒng)狀態(tài),進(jìn)而導(dǎo)致量測值中沒有未知輸入d3k的信息。 圖2 未知輸入dk的估計(jì)值 圖3和圖4分別是應(yīng)用NRTSF得到的系統(tǒng)狀態(tài)的估計(jì)結(jié)果圖和系統(tǒng)狀態(tài)估計(jì)誤差結(jié)果圖,由于未知輸入分別加在前3個系統(tǒng)狀態(tài)分量,所以圖中分別給出了前3個系統(tǒng)狀態(tài)x1k、x2k和x3k的真實(shí)值、估計(jì)值以及估計(jì)誤差,由圖3和圖4可以看出狀態(tài)估計(jì)值都能夠跟蹤狀態(tài)真實(shí)值。 圖3 系統(tǒng)狀態(tài)及其估計(jì)值 圖4 系統(tǒng)狀態(tài)估計(jì)誤差 本文針對系統(tǒng)方程含有未知輸入的情況,討論了同時估計(jì)未知輸入和狀態(tài)的問題,針對經(jīng)典濾波器的不足,提出一種新的三步迭代濾波器,其可以解決系統(tǒng)方程中未知輸入系數(shù)矩陣不滿秩時,經(jīng)典濾波器無法使用的問題。仿真結(jié)果表明,新濾波器能夠有效估計(jì)未知輸入及系統(tǒng)狀態(tài)。2.1 時間更新
2.2 虛擬未知輸入估計(jì)
2.3 測量更新
2.4 NRTSF迭代步驟總結(jié)
3 仿真結(jié)果分析
4 結(jié)語