已知一物體作自由落體運(yùn)動(dòng)對(duì)其高度進(jìn)行了20次測(cè)量_第1頁(yè)
已知一物體作自由落體運(yùn)動(dòng)對(duì)其高度進(jìn)行了20次測(cè)量_第2頁(yè)
已知一物體作自由落體運(yùn)動(dòng)對(duì)其高度進(jìn)行了20次測(cè)量_第3頁(yè)
已知一物體作自由落體運(yùn)動(dòng)對(duì)其高度進(jìn)行了20次測(cè)量_第4頁(yè)
已知一物體作自由落體運(yùn)動(dòng)對(duì)其高度進(jìn)行了20次測(cè)量_第5頁(yè)
已閱讀5頁(yè),還剩12頁(yè)未讀, 繼續(xù)免費(fèi)閱讀

下載本文檔

版權(quán)說(shuō)明:本文檔由用戶提供并上傳,收益歸屬內(nèi)容提供方,若內(nèi)容存在侵權(quán),請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)

文檔簡(jiǎn)介

1、精選優(yōu)質(zhì)文檔-傾情為你奉上1、已知一物體作自由落體運(yùn)動(dòng),對(duì)其高度進(jìn)行了20次測(cè)量,測(cè)量值如下表: 時(shí)間s1234567高度km1.99451.97941.95541.92141.87771.82501.7598時(shí)間s891011121314高度km1.68671.60361.50921.40761.29441.17241.0399時(shí)間s151617181920高度km0.89800.74550.58500.41250.23180.0399設(shè)高度的測(cè)量誤差是均值為0、方差為1的高斯白噪聲隨機(jī)序列,該物體的初始高度和速度也是高斯分布的隨機(jī)變量,且。試求該物體高度和速度隨時(shí)間變化的最優(yōu)估計(jì)。()解:

2、選取系統(tǒng)的狀態(tài)變量為,為物體在k時(shí)刻的高度,為物體在k時(shí)刻的瞬時(shí)速度。這里不考慮過(guò)程噪聲的存在。由牛頓第二運(yùn)動(dòng)定律可以寫出系統(tǒng)的狀態(tài)方程:(由采樣周T=1s,根據(jù)離散化的方法得離散的狀態(tài)方程) 其中 ,建立如下的測(cè)量方程:其中。應(yīng)用卡爾曼濾波算法可以得到物體的高度和速度隨時(shí)間變化的最優(yōu)估計(jì),卡爾曼濾波算法為:一步預(yù)測(cè):預(yù)測(cè)方差:濾波增益:濾波計(jì)算:P濾波方差:由題設(shè),濾波初始值為:= 測(cè)量誤差為:EV(k+1)=0 , Var V(k+1)=1采用MATLAB軟件進(jìn)行計(jì)算,程序清單為:A=1 -1;0 1;B=-1/2;1;C=1 0;U=9.80; R=1;h1=1994.5 1979.4

3、1955.4 1921.4 1877.7 1825.0 1759.8 1686.7 1603.6 1509.2 1407.6 1294.4 1172.4 1039.9 898 745.5 585 412.5 231.8 39.9;x=1900 10'p=100 0;0 2;t=1:20;he=zeros(1,length(t);for i=1:20 x=A*x+B*U; %一步預(yù)測(cè) p=A*p*A' %一步預(yù)測(cè)誤差方差矩陣 k=p*C'*inv(R+C*p*C'); %濾波增益 x=x+k*(h1(i)-C*x); %濾波值 h2(i)=x(1,:); %保存高

4、度濾波值 v(i)=x(2,:); %保存速度濾波值 p=(eye(2)-k*C)*p; %濾波方差 P1(i)=p(1,1) P2(i)=p(2,2)endfigure(1),plot(t,h1','r',t,h2','*');legend('濾波曲線','測(cè)量曲線')title('濾波曲線和測(cè)量曲線')figure(2),plot(t,v');legend('速度曲線')title('速度曲線')figure(3) plot(P1,'r')

5、;legend('高度方差')title('高度方差')figure(4) plot(P2,'r')legend('速度方差')title('速度方差')運(yùn)行程序,得到的物體高度和速度隨時(shí)間變化的最優(yōu)估計(jì)如下表所示:時(shí)間s測(cè)量高度m高度的最優(yōu)估計(jì)m速度的最優(yōu)估計(jì)m/s11994.51993.417.67621979.41977.323.23831955.41953.730.5541921.41920.339.551877.7187748.96461825.01824.158.571759.81760.368.391

6、81686.71686.978.21491603.61603.788.024101509.21510.297.909111407.61407.5107.7121294.41294.7117.52131172.41172.3127.32141039.91040.1137.1215898.0898.03146.9216745.5746.05156.7417585.0584.54166.5318412.5412.98176.3419231.8231.76186.142039.940.566195.95上表為物體隨時(shí)間變化的高度量測(cè)值和高度,速度的最優(yōu)估計(jì)值按此計(jì)算結(jié)果繪制的曲線圖如下:結(jié)果分析:此題

7、中我們利用初值和P(0)根據(jù)卡爾曼濾波算法遞推的求出了物體的高度和速度的最優(yōu)估計(jì),從物體的高度的最優(yōu)估計(jì)曲線中我們可以看到,物體的高度最優(yōu)估計(jì)值和實(shí)際測(cè)量值幾乎相等,物體的速度的最優(yōu)估計(jì)也和自由落體的速度幾乎一致,只是在初始濾波時(shí)有一定的的偏差,這是由于濾波初值選取決定的。在許多實(shí)際問(wèn)題中,往往不能精確知道初值。很顯然此時(shí)計(jì)算得到的濾波值將不是最優(yōu)的。根據(jù)相應(yīng)的判定準(zhǔn)則,我們知道該系統(tǒng)是一致完全能和一直完全能觀的。即它的最優(yōu)線性最優(yōu)濾波系統(tǒng)是一直漸近穩(wěn)定的,所以濾波初值選取只影響濾波的初始階段,系統(tǒng)的濾波最終會(huì)趨向穩(wěn)定。這是有系統(tǒng)自身的特性決定的。因此初值任意選取并不會(huì)影響濾波的最后階段的結(jié)果

8、。顯然,上述結(jié)果是在測(cè)量誤差矩陣R精確可知的情況下得到的。如果R不精確,那么由上述算法給出的將不是X(k)的最優(yōu)估計(jì)。并且此時(shí),濾波還可能發(fā)散。這時(shí)我們可以采用噪聲不精確(未知)系統(tǒng)的自適應(yīng)濾波:可以先選取一個(gè)適當(dāng)?shù)牧繙y(cè)噪聲矩陣并將它固定下來(lái),然后按照動(dòng)態(tài)噪音不精確的情況設(shè)計(jì)自適應(yīng)濾波。本題中假設(shè)測(cè)量誤差為均值為0,方差為1的高斯白色噪聲隨機(jī)序列,并且初始高度和速度相互獨(dú)立。顯然這種假設(shè)是比較理想的狀況。如果測(cè)量誤差為有色噪聲,此時(shí)我們可以通過(guò)適當(dāng)?shù)淖儞Q把系統(tǒng)方程中的有色噪聲轉(zhuǎn)變成白色噪聲的情形處理,從而得到一個(gè)白色噪聲作用下的離散線性系統(tǒng),有此系統(tǒng)的濾波算法導(dǎo)出原系統(tǒng)的濾波算法。由上圖可以看

9、出,速度的濾波方差在最初的時(shí)間內(nèi)很大(接近于2),高度濾波方差在初始時(shí)更大(接近于100),但是很快速度濾波方差就收斂到0;而高度的濾波方差收斂速度比速度濾波方差的要慢,但是最終也收斂到了某個(gè)穩(wěn)態(tài)值。改變參數(shù)看影響:將濾波初值、初值方差、測(cè)量噪聲方差分別變化,其相應(yīng)濾波方差如圖所示:綜上所示,濾波初值的改變對(duì)濾波方差影響不大(其實(shí)這一點(diǎn)在卡爾曼濾波算法中也可看出),而改變初值方差、測(cè)量噪聲方差對(duì)濾波方差有較大的影響。初值方差和測(cè)量噪聲方差的增加都會(huì)使高度方差和速度方差變大,且收斂速度變慢;相應(yīng)地,他們的減少也都會(huì)使高度方差和速度方差變小,收斂速度變快。從統(tǒng)計(jì)學(xué)的角度講,方差代表數(shù)據(jù)的精度,方差

10、大則數(shù)據(jù)偏離真值副度就大,數(shù)據(jù)本身的可靠性就差,數(shù)據(jù)所帶來(lái)的信息就小,所帶來(lái)的誤差就大(根據(jù)誤差理論的誤差可傳遞性)。2、同樣考慮自由落體運(yùn)動(dòng)的物體,用雷達(dá)(和物體落地點(diǎn)在同一水平面)進(jìn)行測(cè)量,如圖所示。如果,且雷達(dá)測(cè)距和測(cè)角的測(cè)量噪聲是高斯白噪聲隨機(jī)序列,均值為零、方差陣,試根據(jù)下列測(cè)量數(shù)據(jù)確定物體的高度和速度隨時(shí)間變化的估計(jì)值。時(shí)間s*1000斜距km俯仰角rad*1000 0.000 2.891 0.876 0.000 2.771 0.478 0.000 2.236 0.639 0.000 2.901 0.802 0.000 2.244 0.452 0.000 2.089 0.819 0

11、.000 2.039 0.213 0.000 2.313 0.379 0.000 2.551 0.545 0.000 2.195 0.034 0.000 2.812 0.986 0.000 2.312 0.530 0.000 2.473 0.495 0.000 2.220 0.639 0.000 2.333 0.069 0.000 2.357 0.706 0.000 2.785 0.081 0.000 2.843 0.971 0.000 2.797 0.368 0.000 2.246 0.588 0.000 2.386 0.452 0.000 2.982 0.978 0.000 2.088 0

12、.025 0.000 2.696 0.544 0.000 2.332 0.781 0.000 2.137 0.328 0.000 2.453 0.348 0.000 2.401 0.918 0.000 2.535 0.708 0.000 2.466 0.281 0.000 2.271 0.972 0.000 2.706 0.986 0.000 2.727 0.142 0.000 2.195 0.262 0.000 2.767 0.980 0.000 2.031 0.579 0.000 2.357 0.465 0.000 2.579 0.160 0.000 2.395 -0.964 0.000

13、2.913 0.068雷達(dá)物體Vhd0斜距俯仰角圖2示意圖解:選取系統(tǒng)的狀態(tài)變量為,其中為雷達(dá)距離目標(biāo)的水平距離,在物體的自由下落過(guò)程中可以認(rèn)為是常值,為物體在k時(shí)刻的高度,為物體在k時(shí)刻的速度。這里不考慮過(guò)程噪聲的存在。由牛頓第二運(yùn)動(dòng)定律可以建立系統(tǒng)的狀態(tài)方程為:(由采樣周T=0.5s,根據(jù)離散化的方法得離散的狀態(tài)方程) 其中 , ,測(cè)量方程如下:設(shè)hX(k),k=H(k)= 應(yīng)用擴(kuò)展卡爾曼濾波算法可以得到物體的高度和速度隨時(shí)間變化的最優(yōu)估計(jì),擴(kuò)展卡爾曼濾波算法為:一步預(yù)測(cè):預(yù)測(cè)方差:濾波增益:濾波計(jì)算:濾波方差:由題設(shè),濾波初始值為: 測(cè)量誤差為:EV(k+1)=0 , 方差采用MATLA

14、B軟件進(jìn)行計(jì)算,程序清單為:A=1 0 0;0 1 -0.5;0 0 1;B=0;-0.125;0.5;U=9.80; R=0.04 0;0 0.01;C=1000* 2.891 0.876; 2.771 0.478; 2.236 0.639; 2.901 0.802; 2.244 0.452; 2.089 0.819; 2.039 0.213; 2.313 0.379; 2.551 0.545; 2.195 0.034; 2.812 0.986; 2.312 0.530; 2.473 0.495; 2.220 0.639; 2.333 0.069; 2.357 0.706; 2.785 0.

15、081; 2.843 0.971; 2.797 0.368; 2.246 0.588; 2.386 0.452; 2.982 0.978; 2.088 0.025; 2.696 0.544; 2.332 0.781; 2.137 0.328; 2.453 0.348; 2.401 0.918; 2.535 0.708; 2.466 0.281; 2.271 0.972; 2.706 0.986; 2.727 0.142; 2.195 0.262; 2.767 0.980; 2.031 0.579; 2.357 0.465; 2.579 0.160; 2.395 -0.964; 2.913 0.

16、068; %輸入測(cè)量數(shù)據(jù)x=1995 2005 1'p=5 0 0;0 5 0;0 0 2;t=0.5:0.5:20;h=zeros(1,length(t);v=zeros(1,length(t);for i=1:length(t)hh(i)=C(i,1)*sin(C(i,2);endfor i=1:length(t) x=A*x+B*U; %一步預(yù)測(cè) p=A*p*A' %一步預(yù)測(cè)誤差方差矩陣H=x(1,1)/sqrt(x(1,1)2+x(2,1)2),x(2,1)/sqrt(x(1,1)2+x(2,1)2),0; -x(2,1)/(x(1,1)2+x(2,1)2),x(1,1

17、)/(x(1,1)2+x(2,1)2),0 k=p*H'*inv(R+H*p*H'); %濾波增益 x=x+k*(C(i,:)'-sqrt(x(1,1)2+x(2,1)2);atan(x(2,1)/x(1,1); %濾波值 h(i)=x(2,:); %保存高度濾波值 v(i)=x(3,:); %保存速度濾波值 p=(eye(3)-k*H)*p; %濾波方差 p1(i)=p(1,1); p2(i)=p(2,2); p3(i)=p(3,3);endfigure(1)plot(t,h,'r');title('濾波曲線')figure(2),pl

18、ot(t,hh, 'b');title('高度測(cè)量曲線')figure(3),plot(t,v');title('速度濾波曲線')figure(4),plot(t,p2');title('高度方差曲線')figure(5),plot(t,p3');title('速度方差曲線')disp(h)disp(v)運(yùn)行程序,得到的物體高度和速度隨時(shí)間變化的最優(yōu)估計(jì)如下表所示:時(shí)間s高度的最優(yōu)估計(jì)km速度的最優(yōu)估計(jì)m/s0.0002.00345.87350.0002.00059.23080.0001.9

19、94214.53130.0001.985819.31810.0001.974524.46420.0001.960929.44280.0001.945234.20750.0001.926739.20850.0001.905944.07740.0001.882748.94110.0001.857053.86490.0001.828858.74180.0001.798063.60800.0001.765168.51780.0001.729473.40170.0001.691278.29440.0001.650583.18990.0001.607988.09120.0001.562592.99180.

20、0001.513497.90460.0001.4639102.79650.0001.4103107.71270.0001.3549112.61690.0001.2965117.53550.0001.2365122.43640.0001.1740127.33630.0001.1086132.24990.0001.0407137.16490.0000.9709142.06370.0000.8981146.98170.0000.8228151.89680.0000.7458156.79270.0000.6660161.69810.0000.5843166.58550.0000.4996171.49050.0000.4125176.39560

溫馨提示

  • 1. 本站所有資源如無(wú)特殊說(shuō)明,都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等,如果需要附件,請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙,網(wǎng)頁(yè)內(nèi)容里面會(huì)有圖紙預(yù)覽,若沒(méi)有圖紙預(yù)覽就沒(méi)有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 人人文庫(kù)網(wǎng)僅提供信息存儲(chǔ)空間,僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理,對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯,并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容,請(qǐng)與我們聯(lián)系,我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。

最新文檔

評(píng)論

0/150

提交評(píng)論