卡爾曼濾波器在運(yùn)動(dòng)目標(biāo)中的跟蹤研究概要

南京理工大學(xué)紫金學(xué)院畢業(yè)設(shè)計(jì)闡明書(shū)(論文)作者:戴學(xué)飛學(xué)號(hào)：系：電子工程與光電技術(shù)系專業(yè):電子信息工程題目:卡爾曼濾波器在運(yùn)動(dòng)目的跟蹤中的研究及仿真講師李娟講師李娟指導(dǎo)者：(姓名)(專業(yè)技術(shù)職務(wù))馬玲副專家馬玲副專家評(píng)閱者：(姓名)(專業(yè)技術(shù)職務(wù))年5月南京理工大學(xué)紫金學(xué)院畢業(yè)設(shè)計(jì)（論文）評(píng)語(yǔ)學(xué)生姓名：戴學(xué)飛班級(jí)、學(xué)號(hào)：11電信3班、題目：卡爾曼濾波器在運(yùn)動(dòng)目的跟蹤中的研究仿真綜合成績(jī)：指導(dǎo)者評(píng)語(yǔ)：論文針對(duì)運(yùn)動(dòng)目的跟蹤的問(wèn)題，建立了簡(jiǎn)潔有效的數(shù)學(xué)模型，在問(wèn)題的解決中引入了Kalman濾波器系統(tǒng)，對(duì)其濾波算法進(jìn)行了推導(dǎo)，進(jìn)一步理解了Kalman濾波器的迭代思想，并使用Matlab軟件對(duì)Kalman濾波思想在運(yùn)動(dòng)目的跟蹤問(wèn)題中的應(yīng)用進(jìn)行了仿真驗(yàn)證，仿真成果體現(xiàn)對(duì)的無(wú)誤。論文綜述完整。程序設(shè)計(jì)合理,仿真成果對(duì)的。敘述充足，結(jié)論合理。技術(shù)用語(yǔ)精確，符號(hào)統(tǒng)一，編號(hào)齊全，書(shū)寫(xiě)工整規(guī)范，整潔、對(duì)的。如能加入對(duì)加速度變化的運(yùn)動(dòng)目的進(jìn)行跟蹤則更加好。同意參加答辯，建議成績(jī)良好。指導(dǎo)者(簽字)：年月日

畢業(yè)設(shè)計(jì)（論文）評(píng)語(yǔ)

評(píng)閱者評(píng)語(yǔ)：評(píng)閱者(簽字)：年月日答辯委員會(huì)（小組）評(píng)語(yǔ)：答辯委員會(huì)（小組）負(fù)責(zé)人(簽字)：年月日畢業(yè)設(shè)計(jì)闡明書(shū)（論文）中文摘要卡爾曼濾波是卡爾曼基于線性最小方差預(yù)計(jì)的基礎(chǔ)上，提出的最優(yōu)線性遞推濾波辦法，含有在數(shù)學(xué)構(gòu)造上比較簡(jiǎn)樸、計(jì)算量小、存儲(chǔ)量低、實(shí)時(shí)性高的優(yōu)點(diǎn)?？柭鼮V波在控制理論和控制系統(tǒng)工程中擁有著巨大影響力，并且在工程實(shí)踐上含有重要意義。因此，卡爾曼濾波器廣泛應(yīng)用于雷達(dá)數(shù)據(jù)解決等領(lǐng)域。本文針對(duì)平面內(nèi)勻速直線運(yùn)動(dòng)目的的跟蹤問(wèn)題，采用卡爾曼濾波辦法來(lái)實(shí)現(xiàn)對(duì)運(yùn)動(dòng)目的的跟蹤。Matlab軟件仿真成果顯示跟蹤效果較好，證明采用此法跟蹤運(yùn)動(dòng)目的有效可行，含有一定研究?jī)r(jià)值。核心詞卡爾曼濾波；目的跟蹤；最優(yōu)；Matlab仿真畢業(yè)設(shè)計(jì)闡明書(shū)（論文）外文摘要TitleResearchonObjectTrackingBasedonKalmanFilterAbstractKalmanfilterisbasedonlinearminimumvarianceestimationandtheoptimallinearrecursivefilteringmethodbytheKalman,withinthemathematicalstructureisrelativelysimple,computationquantityissmall,lowstorageandhighreal-timeperformanceadvantages.Kalmanfilterinthecontroltheoryandcontrolsystemsengineeringhasagreatinfluence,andhasimportantsignificanceinengineeringpractice.Movingtargettrackingiswidelyusedinradardataprocessing.Aimingatthetrackingquestionofamovingtargetwithconstantvelocityalongalineinaflatsurface,wecanuseKalmanfilteringmethod,simulationwithMatlabresultsshowthattheeffectoftractingisveryperfect.Ithasgoodvalues.KeyWordsKalmanFilter;ObjectTracking;Optimal;Matlab目次TOC\o"1-2"\h\z\u1緒論 11．1研究意義以及目的 11．2國(guó)內(nèi)外研究現(xiàn)狀 21．3論文內(nèi)容以及構(gòu)造篇章 32Matlab軟件介紹 52.1軟件介紹 52.2Matlab基本功效 52.3Matlab優(yōu)點(diǎn) 52.4Matlab的應(yīng)用 63卡爾曼濾波器原理 83.1狀態(tài)轉(zhuǎn)移 83.2狀態(tài)預(yù)測(cè) 93.3協(xié)方差矩陣 93.4噪聲協(xié)方差矩陣的傳遞 103.5觀察矩陣 113.6狀態(tài)更新 113.7噪聲協(xié)方差矩陣的更新 123.8卡爾曼濾波的五個(gè)公式 123.9卡爾曼變量和參數(shù) 134蒙特卡洛仿真實(shí)驗(yàn)的數(shù)學(xué)思想 144.1蒙特卡洛辦法的產(chǎn)生與發(fā)展 144.2蒙特卡洛基本原理 165基本動(dòng)態(tài)系統(tǒng)模型 175.1運(yùn)動(dòng)目的數(shù)學(xué)模型建立 175.2Matlab程序代碼及其注釋 185.3Matlab仿真成果以及分析 205.4對(duì)運(yùn)動(dòng)目的跟蹤非線性問(wèn)題的初步探討 26結(jié)論 27致謝 28參考文獻(xiàn) 錯(cuò)誤！未定義書(shū)簽。1緒論1．1研究意義以及目的卡爾曼濾波器是最優(yōu)的遞歸算法。針對(duì)于許多實(shí)際問(wèn)題的解決它是效率最高的，最佳的，最有用的辦法?？柭鼮V波器已經(jīng)在機(jī)器人導(dǎo)航與控制系統(tǒng)，傳感器數(shù)據(jù)融合，軍事雷達(dá)和彈道軌跡外推等領(lǐng)域被廣泛應(yīng)用。在近來(lái)的幾年，它在計(jì)算機(jī)圖像解決方面占據(jù)著非常重要的地位，如人臉識(shí)別，圖像邊沿檢測(cè)與圖像分割技術(shù)和操作系統(tǒng)等技術(shù)領(lǐng)域。卡爾曼濾波器最初是專為飛行器導(dǎo)航而研制的，已成功地被應(yīng)用在諸多領(lǐng)域?？柭鼮V波器重要用來(lái)預(yù)估那些只能被系統(tǒng)本身間接或不精確觀察的系統(tǒng)狀態(tài)。因此卡爾曼濾波器在諸多工程系統(tǒng)和嵌入式系統(tǒng)中占據(jù)著重要的地位。雷達(dá)測(cè)量系統(tǒng)中，目的跟蹤往往是人們非常關(guān)注的方面，但測(cè)量運(yùn)動(dòng)目的的位置、速度和加速度在每時(shí)每刻都存在噪聲信號(hào)?？柭鼮V波是基于運(yùn)動(dòng)目的動(dòng)態(tài)信息，設(shè)法消除噪聲干擾，從而獲取目的位置的最佳預(yù)計(jì)。這個(gè)預(yù)計(jì)過(guò)程重要有三個(gè)方面，第一種方面是對(duì)運(yùn)動(dòng)目的現(xiàn)在位置的預(yù)計(jì)，第二個(gè)方面是對(duì)運(yùn)動(dòng)目的將來(lái)位置的預(yù)計(jì)，第三個(gè)方面是對(duì)運(yùn)動(dòng)目的過(guò)去位置的預(yù)計(jì)。如果需要對(duì)某一運(yùn)動(dòng)中的目的進(jìn)行跟蹤，首先需要做的是對(duì)運(yùn)動(dòng)目的進(jìn)行跟蹤觀察，普通狀況下得到的觀察信息是不精確的，由于它包含著所需要的信息以及隨機(jī)觀察噪聲和干擾信號(hào)。如何從這些觀察信息和噪聲的信號(hào)中提取所需要的數(shù)據(jù)和多個(gè)參數(shù)，因此根據(jù)預(yù)測(cè)的將來(lái)狀態(tài)的觀察數(shù)據(jù)和運(yùn)動(dòng)目的跟蹤辦法的核心是預(yù)測(cè)辦法。卡爾曼濾波遞推算法的原理是運(yùn)用噪聲和觀察噪聲以及輸入和輸出值進(jìn)行的測(cè)量，它是含有統(tǒng)計(jì)特性的預(yù)計(jì)系統(tǒng)。重要思想是：運(yùn)用前一時(shí)刻對(duì)現(xiàn)在時(shí)刻的預(yù)測(cè)，現(xiàn)在的觀察值來(lái)更新對(duì)狀態(tài)量的預(yù)計(jì)（得到現(xiàn)在時(shí)刻的最優(yōu)預(yù)測(cè)值），從而求出下一時(shí)刻的預(yù)測(cè)值，實(shí)現(xiàn)遞歸的預(yù)測(cè)，達(dá)成及時(shí)精確跟蹤的效果。基本卡爾曼濾波器（KF）的約束條件下，即，系統(tǒng)必須是線性的，但大多數(shù)的系統(tǒng)都是非線性系統(tǒng)，因此大多數(shù)狀況下，需要用到擴(kuò)展卡爾曼濾波（EKF）來(lái)對(duì)非線性系統(tǒng)進(jìn)行預(yù)計(jì)。隨著卡爾曼濾波理論的升華，和某些實(shí)用的卡爾曼濾波技術(shù)不停被提出，如自適應(yīng)濾波和次優(yōu)濾波技術(shù)以及濾波散發(fā)克制技術(shù)等等已廣泛應(yīng)用到各個(gè)領(lǐng)域。其它濾波理論也很快得到重視，如線性離散系統(tǒng)的濾波（序列平方根濾波，信息平方根濾波，UD分解濾波）[3]?？柭鼮V波作為一種數(shù)值預(yù)計(jì)優(yōu)化辦法，與應(yīng)用領(lǐng)域的背景結(jié)合性很強(qiáng)。因此卡爾曼濾波用于解決諸多實(shí)際問(wèn)題時(shí)，重要的不僅僅是算法優(yōu)化問(wèn)題與實(shí)現(xiàn)，更重要的是運(yùn)用獲取的領(lǐng)域知識(shí)對(duì)被認(rèn)識(shí)系統(tǒng)進(jìn)行形式化描述，建立起適宜的數(shù)學(xué)模型，再?gòu)倪@個(gè)模型出發(fā)，進(jìn)行濾波器的設(shè)計(jì)與實(shí)現(xiàn)工作。由于卡爾曼濾波含有實(shí)時(shí)遞推，存儲(chǔ)容量非常小和設(shè)計(jì)起來(lái)比較簡(jiǎn)樸等優(yōu)點(diǎn)，因此卡爾曼濾波器在工程領(lǐng)域應(yīng)用十分廣泛。例如在信號(hào)解決、衛(wèi)星控制、石油勘探、故障診療、GPS定位、檢測(cè)與預(yù)計(jì)、控制、通信、航空航天、制導(dǎo)、目的跟蹤、多傳感器信息融合，機(jī)器人學(xué)和生物醫(yī)學(xué)領(lǐng)域。1．2國(guó)內(nèi)外研究現(xiàn)狀馬里蘭大學(xué)的實(shí)時(shí)監(jiān)控系統(tǒng)W4能夠基于單攝像頭對(duì)人體或者人體的各個(gè)部分進(jìn)行實(shí)時(shí)地跟蹤。所謂W4是指，在哪里，什么人，什么時(shí)候，干什么，換句話說(shuō)是指該系統(tǒng)能夠擬定什么目的，什么時(shí)候，什么地方，干什么。W4是基于身體和頭部，手等功效目的形狀分析，基于背景分離功效的自適應(yīng)前背景分離技術(shù)，和區(qū)域分裂合并到目的的交互功效。現(xiàn)在，在美國(guó)，日本，歐洲已進(jìn)行了大量有關(guān)運(yùn)動(dòng)目的檢測(cè)和跟蹤的研究工作，W4是一種基于視覺(jué)監(jiān)控系統(tǒng)能夠?qū)κ彝膺\(yùn)動(dòng)目的進(jìn)行實(shí)時(shí)檢測(cè)和跟蹤，而IBM等大公司資助有關(guān)的研究領(lǐng)域，但愿能將研究成果應(yīng)用于商業(yè)領(lǐng)域。Pfinder是一款基于運(yùn)動(dòng)目的的顏色和形狀特性使用實(shí)時(shí)追蹤系統(tǒng)對(duì)大視角范疇的運(yùn)動(dòng)目的進(jìn)行追蹤與測(cè)量的系統(tǒng)。同時(shí)也出現(xiàn)在許多國(guó)際會(huì)議與討論小組。Pfinder系統(tǒng)的實(shí)現(xiàn)有助于協(xié)助對(duì)室內(nèi)人員的行為進(jìn)行監(jiān)控與行為鑒定。同時(shí)在交通系統(tǒng)中，Tai等人研究了一種視頻監(jiān)控系統(tǒng)用來(lái)交通事件檢測(cè)的，能夠自動(dòng)檢測(cè)車輛和其運(yùn)行軌跡的鑒定。VISATRAM系統(tǒng)能夠?qū)γ總€(gè)車道的車輛行為監(jiān)控，保障交暢通通Haag和Nagel專門機(jī)動(dòng)車輛跟蹤的問(wèn)題進(jìn)行了進(jìn)一步研究與發(fā)現(xiàn)，Pai等人基于十字路口的行人檢測(cè)與跟蹤實(shí)現(xiàn)行人數(shù)量統(tǒng)計(jì)的功效?，F(xiàn)在，在國(guó)外某些基本的視頻目的檢測(cè)與追蹤系統(tǒng)已經(jīng)比較成熟了。例如，卡內(nèi)基梅隆大學(xué)的視頻安全和控制方案研究。根據(jù)計(jì)劃，科研人員開(kāi)發(fā)了一款端到端的測(cè)試系統(tǒng)，集成了含有許多先進(jìn)視頻安全監(jiān)控技術(shù)，如基于靜態(tài)背景和運(yùn)動(dòng)背景對(duì)運(yùn)動(dòng)目的進(jìn)行實(shí)時(shí)測(cè)量與追蹤，普通的目的記別（如人，汽車，卡車）分類，特殊的對(duì)象（如學(xué)校的公共汽車和有特殊標(biāo)記的物體）的姿勢(shì)預(yù)計(jì)和分類識(shí)別，以及和相機(jī)的獨(dú)立控制，多攝像機(jī)協(xié)同跟蹤人體步伐分析等。在國(guó)內(nèi)的研究中也出現(xiàn)了一定的規(guī)模，舉辦了有關(guān)會(huì)議，探討了有關(guān)的研究成果和將來(lái)的發(fā)展方向。20世紀(jì)60年代末，我國(guó)開(kāi)始對(duì)視頻目的檢測(cè)與追蹤技術(shù)進(jìn)行研究，通過(guò)40數(shù)年的不懈努力與投入，我國(guó)在這一領(lǐng)域得到了相稱大發(fā)展，許多先進(jìn)的圖像解決和模式識(shí)別辦法應(yīng)用于這一領(lǐng)域，同時(shí)某些實(shí)際系統(tǒng)的得到開(kāi)發(fā)機(jī)會(huì)。中國(guó)的先進(jìn)的影像識(shí)別和智能化程度，普通跟蹤技術(shù)，多目的的實(shí)時(shí)測(cè)量，低對(duì)比度和復(fù)雜的視頻圖像信息解決與國(guó)外相比還存在較大的差距。在實(shí)際過(guò)程跟蹤方面仍然存在著許多問(wèn)題，如數(shù)據(jù)同時(shí)，含糊圖像，跟蹤穩(wěn)定性差等，由于這些方面的實(shí)用信息從國(guó)外獲得的極少，因此在這一領(lǐng)域進(jìn)行了進(jìn)一步的研究，以提高我國(guó)的國(guó)防實(shí)力，加強(qiáng)公民行為起著重要的作用?，F(xiàn)在，某些高校和科研機(jī)構(gòu)都開(kāi)展了這項(xiàng)工作。相比之下，智能視頻監(jiān)控技術(shù)在國(guó)內(nèi)的研究起步較晚，但隨著數(shù)字圖像解決技術(shù)，計(jì)算機(jī)視覺(jué)等多個(gè)紅外、雷達(dá)、激光傳感器技術(shù)的不停發(fā)展，運(yùn)動(dòng)目的檢測(cè)與跟蹤技術(shù)的研究提供了必要的理論基礎(chǔ)和技術(shù)支持，發(fā)明環(huán)境的研究不可比擬的優(yōu)越性。如視覺(jué)與聽(tīng)覺(jué)信息解決國(guó)家擁有著重點(diǎn)實(shí)驗(yàn)室，例如北京大學(xué)高智能機(jī)器感知系統(tǒng)實(shí)驗(yàn)室在三維視覺(jué)信息解決與智能機(jī)器人領(lǐng)域的研究獲得了許多成果[4]。1．3論文內(nèi)容以及構(gòu)造篇章本論文在對(duì)卡爾曼遞推濾波算法進(jìn)行數(shù)學(xué)推導(dǎo)的基礎(chǔ)上研究卡爾曼濾波原理在雷達(dá)跟蹤中的應(yīng)用。針對(duì)一平面內(nèi)運(yùn)動(dòng)目的，運(yùn)用卡爾曼濾波辦法進(jìn)行目的軌跡跟蹤,采用蒙特卡洛辦法通過(guò)Matlab7.0軟件進(jìn)行濾波跟蹤仿真，具體涉及卡爾曼濾波增益和誤差方差陣計(jì)算，最后對(duì)誤差進(jìn)行分析。為簡(jiǎn)便研究分析，將運(yùn)動(dòng)目的的觀察的噪聲假設(shè)為高斯白色噪聲，并且討論普通的非平穩(wěn)的狀況。本論文的內(nèi)容安排以下：第一章緒論是對(duì)本課題研究的目的以及意義進(jìn)行分析。只有在理解課題研究背景和研究現(xiàn)狀的前提下，才干更加好地開(kāi)展設(shè)計(jì)工作。第二章對(duì)Matlab軟件作簡(jiǎn)要介紹，這是對(duì)卡爾曼濾波模型進(jìn)行模擬的最佳軟件。第四章介紹了蒙特卡洛仿真實(shí)驗(yàn)的數(shù)學(xué)思想，并針對(duì)函數(shù)積分問(wèn)題求解中的應(yīng)用做了具體的分析，最后總的介紹了蒙特卡洛基本原理。第三章和第五章是本論文的重點(diǎn)。第三章具體介紹了卡爾曼濾波器的基本原理，分析了各個(gè)公式的意義以及作用，并對(duì)卡爾曼濾波器重要方程式進(jìn)行總結(jié)，多個(gè)卡爾曼參數(shù)進(jìn)行闡明。第五章在第三章對(duì)卡爾曼濾波器原理具體剖析的基礎(chǔ)之上，針對(duì)一種平面內(nèi)小汽車運(yùn)動(dòng)目的的雷達(dá)跟蹤問(wèn)題，使用卡爾曼遞推濾波辦法求解。以及運(yùn)用軟件Matlab進(jìn)行運(yùn)動(dòng)目的仿真驗(yàn)證，并且分析運(yùn)動(dòng)目的速度和位置的方差。并且對(duì)運(yùn)動(dòng)目的跟蹤非線性問(wèn)題的初步探討。

2Matlab軟件介紹2.1軟件介紹Matlab的簡(jiǎn)稱是矩陣實(shí)驗(yàn)室（MatrixLaboratory），是由美國(guó)MathWorks公司開(kāi)發(fā)的高級(jí)技術(shù)計(jì)算機(jī)語(yǔ)言和交互式環(huán)境的商業(yè)數(shù)學(xué)軟件，其重要有兩大部分構(gòu)成的，Matlab和Simulink。Matlab和Mathematica、Maple三者并稱數(shù)學(xué)三大軟件。Matlab重要突出的方面體現(xiàn)在對(duì)數(shù)學(xué)類科技應(yīng)用問(wèn)題上的數(shù)值計(jì)算。Matlab有諸多功效，例如能夠進(jìn)行矩陣運(yùn)算實(shí)現(xiàn)算法、創(chuàng)立顧客界面、繪制函數(shù)和數(shù)據(jù)、連接其它編程語(yǔ)言的程序等[1]。2.2Matlab基本功效Matlab是一種完美地將數(shù)據(jù)構(gòu)造和編程特性以及圖形顧客界面結(jié)合到一起的數(shù)學(xué)軟件，由美國(guó)MathWorks公司開(kāi)發(fā)研制的。它為自己的顧客提供了矩陣運(yùn)算功效和靈活的數(shù)組運(yùn)算功效等，這些都是顧客經(jīng)常使用的某些功效。它與此同時(shí)還能夠與Fortran語(yǔ)言和C語(yǔ)言進(jìn)行混合編程，大大提高了編程效率，因此進(jìn)一步擴(kuò)大了它的功效。其中特別重要的有下列幾點(diǎn)：1）復(fù)雜的矩陣或數(shù)組數(shù)據(jù)的單元操作，能直接解決矩陣或數(shù)組。2）編程語(yǔ)言構(gòu)造十分緊湊，內(nèi)涵非常豐富，編程效率相稱高，顧客使用很方便。3）繪制圖型功效十分強(qiáng)大，復(fù)雜的二維圖形和三維圖形顧客只需要編寫(xiě)很短的程序代碼就能夠繪制出來(lái)了。4）為顧客提供了豐富的調(diào)用函數(shù)，顧客可直接使用，不需要顧客自己編程，提高了編程效率，例如顧客需規(guī)定解微分方程或微分方程組的解那么就能夠使用系統(tǒng)提供的Dsolve函數(shù)、如果需規(guī)定解線性方程組的解那么使用提供的Solve函數(shù)就行了[1]。2.3Matlab優(yōu)點(diǎn)Matlab中通過(guò)使用為顧客提供的可視化動(dòng)態(tài)仿真環(huán)境———Simulink，能夠?qū)崿F(xiàn)對(duì)動(dòng)態(tài)系統(tǒng)的非常直觀建模以及對(duì)動(dòng)態(tài)系統(tǒng)的仿真與分析，并且Matlab也支持持續(xù)時(shí)間、離散時(shí)間以及持續(xù)和離散時(shí)間互相交替的線性系統(tǒng)和非線性系統(tǒng)進(jìn)行仿真測(cè)試功效，因此能夠使一種非常復(fù)雜系統(tǒng)的輸入和仿真都變得十分簡(jiǎn)樸明[3]。Matlab能夠合用于許多學(xué)科、部門的多個(gè)規(guī)定，Matlab的基本數(shù)據(jù)單位是矩陣。和C語(yǔ)言，F(xiàn)ORTRAN語(yǔ)言等編程語(yǔ)言相比，Matlab的指令體現(xiàn)式跟數(shù)學(xué)和工程中的運(yùn)算形式是幾乎完全相似的，因此運(yùn)用Matlab來(lái)求解相似問(wèn)題的解要比用C語(yǔ)言，F(xiàn)ORTRAN語(yǔ)言等語(yǔ)言更加簡(jiǎn)樸容易，并且Maple等軟件的優(yōu)點(diǎn)也被Matlab吸取了，因此Matlab成為一款不僅僅功效強(qiáng)大并且十分實(shí)用的數(shù)學(xué)軟件。在新的版本中C語(yǔ)言、FORTRAN語(yǔ)言、C++語(yǔ)言、JAVA語(yǔ)言也能夠被兼容進(jìn)去使用了。顧客能夠自己編寫(xiě)對(duì)應(yīng)的程序存到Matlab的程序調(diào)用庫(kù)中，方便顧客自己可下列一次編寫(xiě)程序時(shí)直接調(diào)用這些以前編寫(xiě)好的程序。同時(shí)，Matlab庫(kù)中已經(jīng)導(dǎo)入了諸多程序編寫(xiě)愛(ài)好者已經(jīng)編寫(xiě)好的多個(gè)各樣的程序代碼，這些都是某些非常典型的程序代碼，顧客能夠自己直接下載并且使用。2.4Matlab的應(yīng)用顧客能夠根據(jù)直角坐標(biāo)和極坐標(biāo)選擇的需要，柱面和球面坐標(biāo)系統(tǒng)繪制平面曲線和空間曲線和曲面的外觀圖和網(wǎng)絡(luò)圖，也能夠繪制矢量圖，直方圖，直方圖等。另外,Matlab將數(shù)值分析、矩陣計(jì)算、科學(xué)數(shù)據(jù)可視化以及非線性動(dòng)態(tài)系統(tǒng)的建模和仿真等諸多強(qiáng)大的功效集成在一種易于使用的視窗環(huán)境中，為科學(xué)研究、工程設(shè)計(jì)以及必須進(jìn)行有效數(shù)值計(jì)算的眾多科學(xué)領(lǐng)域提供了一種全方面的解決方案，并在很大程度上擺脫了傳統(tǒng)非交互式程序設(shè)計(jì)語(yǔ)言（C、FORTRAN)的編輯模式，代表了當(dāng)今國(guó)際科學(xué)計(jì)算軟件的先進(jìn)水平[8]。在電路和信號(hào)與系統(tǒng)以及數(shù)字信號(hào)解決等自動(dòng)控制原理都是能夠基于Matlab來(lái)實(shí)現(xiàn)的。在這突出介紹下Matlab的繪圖功效。Matlab繪制圖形實(shí)例以下所示：基于Matlab軟件繪制數(shù)列圖形指令:symsnn=1000:10000;xn=(1+1./n).^n;plot(n,xn,':');gridon繪圖成果如圖2.1所示：圖2.1函數(shù)極限圖像直觀地表明了n當(dāng)有限增大時(shí),數(shù)列的變化趨勢(shì),顧客通過(guò)繪圖能夠理解極限概念和含義。

3卡爾曼濾波器原理3.1狀態(tài)轉(zhuǎn)移卡爾曼濾波的本質(zhì)是一種遞推預(yù)計(jì)過(guò)程，只要懂得上次狀態(tài)預(yù)計(jì)和觀察狀態(tài)能夠很容易地得到現(xiàn)在狀態(tài)值，它和其它的預(yù)計(jì)技術(shù)與眾不同，卡爾曼濾波器不需要觀察和預(yù)計(jì)的歷史統(tǒng)計(jì)，卡爾曼濾波器是一種純正的時(shí)域?yàn)V波器，它和其它的頻域?yàn)V波器最大的區(qū)別在于，例如低通、高通、帶通、帶阻等頻域?yàn)V波器，這些是需要在頻域中設(shè)計(jì)，然后在轉(zhuǎn)變屆時(shí)域中使用。但卡爾曼濾波器能夠直接在時(shí)間域內(nèi)設(shè)計(jì)和使用，它適合于實(shí)時(shí)解決數(shù)據(jù)。一種運(yùn)動(dòng)的目的，它現(xiàn)在狀態(tài)能夠?qū)懗删仃囆问骄褪且环N二維的列向量，即它由位置和速度構(gòu)成。如果已知上一時(shí)刻狀態(tài)那么現(xiàn)在時(shí)刻的狀態(tài)的位置及目的運(yùn)動(dòng)速度能夠用下列的表達(dá)辦法 （3.1） （3.2）的狀態(tài)的位置及目的運(yùn)動(dòng)速度的輸出變量都只是其輸入變量的線性組合，這體現(xiàn)了卡爾曼濾波器是最佳的線性濾波器，由于它只能描述狀態(tài)與狀態(tài)之間的線性關(guān)系。由于線性關(guān)系，把它寫(xiě)成矩陣的形式：（3.3）進(jìn)一步提取出兩個(gè)狀態(tài)變換矩陣和（3.4）其中為狀態(tài)轉(zhuǎn)移矩陣，作用在于如何從上一時(shí)刻的狀態(tài)來(lái)推測(cè)現(xiàn)在時(shí)刻的狀態(tài)。為控制矩陣，它表達(dá)控制量如何作用現(xiàn)在狀態(tài)。因此能夠得出卡爾曼公式中第一種公式：。3.2狀態(tài)預(yù)測(cè)（3.5）為對(duì)的預(yù)計(jì)量，由于物體的真實(shí)狀態(tài)無(wú)法懂得，只能根據(jù)所觀察的數(shù)據(jù)盡量的預(yù)計(jì)的真實(shí)值，接著需要根據(jù)觀察來(lái)更新預(yù)測(cè)值，方便得到最佳值。但是全部的推測(cè)過(guò)程都會(huì)包含噪聲影響，噪聲越大，不擬定性也就越大，如何表達(dá)這次推測(cè)帶來(lái)多少不擬定性需要引入?yún)f(xié)方差矩陣。3.3協(xié)方差矩陣先從一維狀況說(shuō)起，以下圖3.1所示假設(shè)有一種一維的數(shù)據(jù)，由于噪聲，每次測(cè)量的值都不相似，但是都是圍繞在一種中心值的范疇。表達(dá)它的最簡(jiǎn)樸方式就記下它的中心值和方差。這事實(shí)上是假設(shè)了它是一種高斯的分布。圖3.1一維噪聲數(shù)據(jù)分布二維的狀況以下圖3.2所示，分別對(duì)兩個(gè)坐標(biāo)軸進(jìn)行投影，在兩個(gè)軸上都是高斯分布。圖3.2二維噪聲數(shù)據(jù)分布如果兩個(gè)維度是互相獨(dú)立的就能夠分別記下中心值和兩個(gè)軸的方差。但是兩個(gè)維度含有有關(guān)性的時(shí)候，例如在一種維度上噪聲增大，另一種維度上噪聲也增大，如果一種維度增大另一種維度減小，這個(gè)時(shí)候?qū)蓚€(gè)坐標(biāo)軸上投影和之前的是同樣的都是高斯分布，因此要表達(dá)兩個(gè)維度的有關(guān)性除了要統(tǒng)計(jì)兩個(gè)維度的方差之外還要協(xié)方差來(lái)表達(dá)兩個(gè)維度之間的有關(guān)程度。寫(xiě)成矩陣的形式：（3.6）對(duì)角線上的兩個(gè)值是兩個(gè)維度的方差，反對(duì)角線上的兩個(gè)值是相等的，是它們的協(xié)方差。在卡爾曼濾波器中全部有關(guān)不擬定性的表述都要用到協(xié)方差矩陣。3.4噪聲協(xié)方差矩陣的傳遞每一種時(shí)刻的不擬定性都是由協(xié)方差矩陣來(lái)表達(dá)的，如何讓這種不擬定性在每一刻之間傳遞呢。（3.7）式（3.7）表達(dá)從上一時(shí)刻的協(xié)方差推測(cè)現(xiàn)在時(shí)刻的協(xié)方差。具體推導(dǎo)根據(jù)協(xié)方差矩陣的性質(zhì)。這個(gè)時(shí)候還要考慮一種問(wèn)題，這個(gè)預(yù)測(cè)模型也不是百分之百精確的，它本身也是包含噪聲的，因此要在背面加上一種協(xié)方差矩陣來(lái)表達(dá)預(yù)測(cè)模型本身帶來(lái)的噪聲。因此公式寫(xiě)成：（3.8）式（3.8）就是卡爾曼濾波器的第二個(gè)公式，它表達(dá)不擬定性在各個(gè)時(shí)刻之間的傳遞關(guān)系。3.5觀察矩陣每一種時(shí)刻都能觀察到物體的位置，觀察到的值，記為，那么從物體本身的狀態(tài)到觀察狀態(tài)之間有一種變化關(guān)系，記為，固然這種變換關(guān)系也只能是線性關(guān)系，由于卡爾曼濾波器是線性濾波器，因此理所固然的要把寫(xiě)成矩陣的形式。也就是所謂的觀察矩陣,和的維度是不一定相似的，如果是一種二維的列向量，是一種標(biāo)量，因此用公式表達(dá)觀察矩陣，其中為觀察的噪聲，這個(gè)觀察的協(xié)方差矩陣用來(lái)表達(dá)，如果觀察的值是一種一維的值，那么這個(gè)的形式也不是一種矩陣，也只是一種值，僅僅表達(dá)的方差，假設(shè)除了用雷達(dá)尚有別的測(cè)量辦法能夠觀察到物體的某項(xiàng)特性,那么就可能是一種多維的列向量，它會(huì)涉及每一種測(cè)量方式的測(cè)量值，而每一種測(cè)量值都是真實(shí)值的一種不完全體現(xiàn)，能夠從幾個(gè)不完全體現(xiàn)中推斷出真實(shí)的狀態(tài)，而卡爾曼濾波器這種數(shù)據(jù)融合功效正是在這種測(cè)量矩陣中體現(xiàn)出來(lái)的。3.6狀態(tài)更新已有了觀察量和它的協(xié)方差矩陣，這個(gè)時(shí)候需要整合進(jìn)去對(duì)狀態(tài)的預(yù)計(jì)。最佳預(yù)計(jì)值得公式是：（3.9）對(duì)式（3.9）分析，加上的這項(xiàng)表達(dá)實(shí)際的觀察值與預(yù)期的觀察值之間的殘差，這殘差乘上一種系數(shù)就能夠修正的值了，這個(gè)十分的核心，它叫做卡爾曼系數(shù)，它也是一種矩陣。（3.10）這個(gè)式（3.10）的推導(dǎo)十分復(fù)雜，這里就定性的來(lái)分析一下。這個(gè)卡爾曼系數(shù)的作用重要有兩個(gè)方面，一是權(quán)衡預(yù)測(cè)狀態(tài)協(xié)方差和觀察量的協(xié)方差矩陣的大小來(lái)決定是相信預(yù)測(cè)模型多一點(diǎn)還是相信觀察模型多一點(diǎn)，如果相信預(yù)測(cè)模型多一點(diǎn)這個(gè)殘差權(quán)重就會(huì)小一點(diǎn)，如果相信觀察模型多一點(diǎn)那么這個(gè)殘差權(quán)重就會(huì)大一點(diǎn)。二是把殘差的體現(xiàn)形式從觀察域轉(zhuǎn)換到狀態(tài)域。剛剛說(shuō)到觀察值只是一種一維的向量，狀態(tài)是一種二維的列向量，它們用的單位甚至是特性都有可能是不同的，那怎么用觀察值的殘差去更新?tīng)顟B(tài)值其實(shí)就要涉及到這個(gè)卡爾曼系數(shù)，事實(shí)上這個(gè)卡爾曼系數(shù)就是在做這樣一種轉(zhuǎn)換，觀察到物體的位置，但是里面已經(jīng)包含了協(xié)方差矩陣的信息，因此它運(yùn)用位置和速度這兩個(gè)維度的有關(guān)性，從位置的殘差里推算出了速度的殘差，從而能夠?qū)顟B(tài)的兩個(gè)維度同時(shí)進(jìn)行修正。3.7噪聲協(xié)方差矩陣的更新（3.11）更新最佳預(yù)計(jì)值得噪聲分布，這個(gè)值是留給下一輪迭代時(shí)候用的，在這一步里狀態(tài)的不擬定性是減小的，而在下一輪里由于傳遞噪聲的引入不擬定性又會(huì)增大，卡爾曼濾波器就是在這種不擬定性的變化中謀求的一種平衡。但是要注意的是這個(gè)公式僅僅在最優(yōu)卡爾曼增益時(shí)它才成立。如果算術(shù)精度總是很低而造成數(shù)值穩(wěn)定性出現(xiàn)問(wèn)題，或者特意使用非最優(yōu)卡爾曼增益，那么就不能使用這個(gè)公式[13]。3.8卡爾曼濾波的五個(gè)公式預(yù)測(cè)：（3.12）（3.13）式（3.12）和式（3.13）是通過(guò)前一種時(shí)刻的狀態(tài)來(lái)預(yù)測(cè)現(xiàn)在時(shí)刻的狀態(tài)，這并不是最佳的預(yù)計(jì)值，它們還欠缺點(diǎn)東西，這個(gè)欠缺的東西就是從觀察里面帶來(lái)的信息，由于還沒(méi)考慮現(xiàn)在時(shí)刻的觀察值。更新：（3.14）（3.15）（3.16）式（3.14）式（3.15）和式（3.16）三個(gè)公式就用現(xiàn)在的觀察值來(lái)更新和,通過(guò)更新后的值就是最佳預(yù)計(jì)值了。3.9卡爾曼變量和參數(shù)表3.1卡爾曼變量和參數(shù)變量定義維數(shù)現(xiàn)在t時(shí)刻位置現(xiàn)在t時(shí)刻速度t時(shí)刻狀態(tài)矩陣21狀態(tài)轉(zhuǎn)移矩陣22控制矩陣21控制量對(duì)的預(yù)計(jì)量21協(xié)方差矩陣22t-1時(shí)刻的協(xié)方差t時(shí)刻的協(xié)方差預(yù)計(jì)噪聲協(xié)方差矩陣觀察值觀察矩陣12觀察協(xié)方差矩陣12觀察噪聲現(xiàn)在位置最佳預(yù)計(jì)值21卡爾曼增益矩陣最佳預(yù)計(jì)的協(xié)方差

4蒙特卡洛仿真實(shí)驗(yàn)的數(shù)學(xué)思想4.1蒙特卡洛辦法的產(chǎn)生與發(fā)展蒙特卡羅（MonteCarlo）辦法，又稱隨機(jī)抽樣或者稱統(tǒng)計(jì)實(shí)驗(yàn)辦法，屬于計(jì)算數(shù)學(xué)的一種分支，它是基于上世紀(jì)四十年代中期為了適應(yīng)當(dāng)時(shí)原子能事業(yè)的發(fā)展而發(fā)展起來(lái)的數(shù)學(xué)辦法[7]。傳統(tǒng)的經(jīng)驗(yàn)辦法之因此很難得到滿意的答案是由于不能逼近真實(shí)的物理過(guò)程，而蒙特卡羅辦法之因此解決問(wèn)題與實(shí)際非常符合是由于能夠真實(shí)地模擬實(shí)際物理過(guò)程，能夠得到很圓滿的成果。20世紀(jì)40年代以來(lái)，隨著電子計(jì)算機(jī)技術(shù)的飛速發(fā)展，人們開(kāi)始能夠使用計(jì)算機(jī)技術(shù)來(lái)模擬這類實(shí)驗(yàn)。計(jì)算機(jī)能夠取代諸多事實(shí)上非常龐大而復(fù)雜的數(shù)字仿真技術(shù)，由于計(jì)算機(jī)含有較高的運(yùn)算速率與存儲(chǔ)容量大的特點(diǎn)，并且對(duì)實(shí)驗(yàn)成果的解決十分快速，于是蒙特卡洛辦法被重新提起，并且蒙特卡洛的應(yīng)用領(lǐng)域越來(lái)越廣泛。特別是相比于可視化編程的多個(gè)辦法不停出現(xiàn)，更加顯示了蒙特卡羅辦法的獨(dú)特之處，視覺(jué)計(jì)算機(jī)數(shù)學(xué)模擬實(shí)驗(yàn)，用數(shù)學(xué)的辦法解決。4.1.1蒙特卡洛辦法求函數(shù)的積分如果要計(jì)算下面函數(shù)的積分：（4.1）其中函數(shù)，如果直接對(duì)函數(shù)積分，成果為。采用蒙特卡洛辦法來(lái)求積分，先設(shè)兩個(gè)隨機(jī)變量和都在區(qū)間上服從均勻分布。這兩個(gè)隨機(jī)變量互相獨(dú)立的，將的樣本點(diǎn)投放到平面上，以下圖4.1所示，那么落在區(qū)域的概率為區(qū)域的面積與正方形的面積之比（正方形面積為1），即：（4.2）可見(jiàn)對(duì)函數(shù)的積分問(wèn)題就轉(zhuǎn)化成了一種概率的計(jì)算問(wèn)題，其優(yōu)點(diǎn)體現(xiàn)在，概率能夠用相對(duì)頻數(shù)來(lái)近似，相對(duì)頻數(shù)是可通過(guò)統(tǒng)計(jì)實(shí)驗(yàn)的辦法求得。具體辦法是將個(gè)隨機(jī)點(diǎn)均勻地投放到平面上的正方形區(qū)域內(nèi)，如果有個(gè)點(diǎn)落在區(qū)域內(nèi)，那么相對(duì)頻數(shù)為，公式以下所示：（4.3）式（4.3）是對(duì)積分的一種預(yù)計(jì)，預(yù)計(jì)的精度重要跟實(shí)驗(yàn)次數(shù)有關(guān)，也稱為蒙特卡洛仿真次數(shù)。下面給出了用蒙特卡洛辦法計(jì)算積分的MATLAB程序。symsx;y1=int(0.5-(0.5-x).^2,0,1);zhenshizhi=eval(y1)N=0;x1=unifrnd(0,1,1,M);y1=unifrnd(0,1,1,M);fori=1:Mify1(i)<=(0.5-(0.5-x1(i)).^2)N=N+1;endendfangzhenzhi=N/M仿真成果如圖4.1所示：圖4.1積分圖從以上的例子能夠看出應(yīng)用蒙特卡洛仿真的普通環(huán)節(jié)：1）建立適宜的概率模型；2）進(jìn)行多次重復(fù)實(shí)驗(yàn)；3）對(duì)重復(fù)實(shí)驗(yàn)成果進(jìn)行統(tǒng)計(jì)分析（預(yù)計(jì)相對(duì)頻數(shù)、均值等）、分析精度。

4.2蒙特卡洛基本原理當(dāng)所規(guī)定解的問(wèn)題是某種事件出現(xiàn)的概率，或者是某個(gè)隨機(jī)變量的盼望值時(shí)，它們能夠通過(guò)某種“實(shí)驗(yàn)”的辦法，得到這種事件出現(xiàn)的頻率，或者這個(gè)隨機(jī)變數(shù)的平均值，并用它們作為問(wèn)題的解。這就是蒙特卡羅辦法的基本思想。[10]蒙特卡羅辦法通過(guò)抓住事物運(yùn)動(dòng)的幾何數(shù)量和幾何特性，運(yùn)用數(shù)學(xué)辦法來(lái)加以模擬，即進(jìn)行一種數(shù)字模擬實(shí)驗(yàn)。它是以一種概率模型為基礎(chǔ)，按照這個(gè)模型所描繪的過(guò)程，通過(guò)模擬實(shí)驗(yàn)的成果，作為問(wèn)題的近似解[10]。能夠把蒙特卡羅解題歸結(jié)為三個(gè)重要環(huán)節(jié)：構(gòu)造或描述概率過(guò)程；實(shí)現(xiàn)從已知概率分布抽樣；建立多個(gè)預(yù)計(jì)量[6]。本論文對(duì)于運(yùn)動(dòng)目的跟蹤模型的仿真即采用蒙特卡洛辦法。

5基本動(dòng)態(tài)系統(tǒng)模型5.1運(yùn)動(dòng)目的數(shù)學(xué)模型建立卡爾曼濾波器是最佳線性濾波器，由于它只能描述線性時(shí)域系統(tǒng)，對(duì)于運(yùn)動(dòng)目的的狀態(tài)轉(zhuǎn)移，輸入和輸出必須是線性關(guān)系，隨著時(shí)間推移，狀態(tài)轉(zhuǎn)移都會(huì)產(chǎn)生一種新的狀態(tài)，同時(shí)每次狀態(tài)轉(zhuǎn)移都會(huì)加入新的控制量，并且每一次的預(yù)測(cè)都會(huì)帶來(lái)噪聲干擾，系統(tǒng)的狀態(tài)到對(duì)目的的觀察也是一種線性的關(guān)系，從狀態(tài)量到觀察量這個(gè)過(guò)程也會(huì)存在噪聲的干擾。卡爾曼濾波器基本動(dòng)態(tài)系統(tǒng)模型如圖5.1所示，向量、矩陣、高斯噪聲分別由圓、正方形、六角星表達(dá)，其觀察噪聲和預(yù)測(cè)噪聲協(xié)方差在右下方正方形中標(biāo)出。圖5.1卡爾曼濾波器基本動(dòng)態(tài)系統(tǒng)模型假設(shè)有一輛小汽車在路上行駛，假設(shè)道路無(wú)限長(zhǎng)，并且筆直，用小汽車的位置和速度來(lái)表達(dá)它現(xiàn)在時(shí)刻的狀態(tài)。駕駛員能夠踩油門也能夠踩剎車使其產(chǎn)生一種向前的加速度或者一種向后的加速度，表達(dá)對(duì)車的一種控制量，如果沒(méi)踩油門也沒(méi)踩剎車，則=0車就會(huì)做勻速直線運(yùn)動(dòng)。在小汽車的左端放置一種雷達(dá)，方便能夠測(cè)出小汽車的位置和速度，但是在整個(gè)測(cè)量和觀察過(guò)程中，都存在噪聲，設(shè)為高斯白噪聲，為了簡(jiǎn)便起見(jiàn)，本文設(shè)小汽車運(yùn)動(dòng)速度為5m/S，10m/S,20m/S的勻速直線運(yùn)動(dòng)。雷達(dá)掃描周期分別為1s、2s和3s進(jìn)行了分析。這個(gè)運(yùn)動(dòng)目的的數(shù)學(xué)模型，能夠用下列差分方程表達(dá)：（5.1）（5.2）和分別表達(dá)小汽車在時(shí)刻的位置和速度，表達(dá)小汽車在的加速度，為了簡(jiǎn)樸起見(jiàn)，我們?cè)谶@里設(shè)加速度為0。那么得出小汽車的狀態(tài)轉(zhuǎn)移方程：（5.2）式（5.2）中，，為均值為0的高斯噪聲，其協(xié)方差矩陣為。其觀察方程為：（5.3）式子中為一種一維的標(biāo)量，它表達(dá)雷達(dá)在時(shí)刻測(cè)量出小汽車的位置，為時(shí)刻小汽車的測(cè)量矩陣，為該過(guò)程測(cè)量的高斯白噪聲，協(xié)方差矩陣為。由于目的的動(dòng)態(tài)模型是線性的，過(guò)程噪聲和測(cè)量噪聲服從高斯分布且互相獨(dú)立，因此能夠運(yùn)用卡爾曼濾波技術(shù)對(duì)目的的位置和速度進(jìn)行預(yù)計(jì)，其預(yù)計(jì)的均方誤差是最小的。對(duì)運(yùn)動(dòng)目的位置和速度的最佳濾波預(yù)測(cè)如表5.1所示：表5.1位置和速度的最佳濾波預(yù)測(cè)預(yù)測(cè)預(yù)測(cè)誤差協(xié)方差Kalman增益濾波濾波協(xié)方差5.2Matlab程序代碼及其注釋clc;Z=5*(1:100);%觀察值noise=randn(1,100);%方差為1的高斯噪聲Z=Z+noise;%觀察帶噪聲的小汽車位置數(shù)值X=[0;0];%汽車的初始狀態(tài)P=[10;01];%狀態(tài)協(xié)方差矩陣F=[11;01];%狀態(tài)轉(zhuǎn)移矩陣Q=[0.0001,0;00.0001];%狀態(tài)轉(zhuǎn)移協(xié)方差矩陣H=[10];%觀察矩陣R=1;%觀察噪聲方差C=0;M=0;L=0;figure;%畫(huà)圖，畫(huà)出濾波100次的圖holdon;%卡爾曼濾波100次開(kāi)始fori=1:100V=5;%產(chǎn)生真實(shí)的速度X_=F*X;%狀態(tài)預(yù)測(cè)公式P_=F*P*F'+Q;%狀態(tài)協(xié)方差矩陣的傳遞K=P_*H'/(H*P_*H'+R);%卡爾曼增益矩陣X=X_+K*(Z(i)-H*X_);%狀態(tài)的更新P=(eye(2)-K*H)*P_;%噪聲協(xié)方差矩陣的更新a(i)=X(1);c(i)=X(2);f(i)=Z(i)%畫(huà)出估算速度的方差和估算位置的方差C=(X(2)-V)^2+C;D=C/i;M=(X(1)-Z(i))^2+M;L=M/i;plot(i,D,'K',i,L,'B');legend('估算的速度的方差','估算位置的方差');endfigure(2)%畫(huà)圖plot(a,c,a,V,'R');legend('估算的速度','真實(shí)的速度');5.3Matlab仿真成果以及分析首先設(shè)定掃描周期為1秒，初始狀態(tài)，小汽車真實(shí)運(yùn)動(dòng)運(yùn)動(dòng)速度為5m/S。如圖5.2所示：圖5.25m/S卡爾曼濾波的成果圖5.35m/S速度和位置估的方差設(shè)定掃描周期為1秒，初始狀態(tài)，小汽車真實(shí)運(yùn)動(dòng)運(yùn)動(dòng)速度為10m/S。如圖5.4所示：圖5.410m/S卡爾曼濾波的成果圖5.510m/S速度和位置估的方差設(shè)定掃描周期為1秒，初始狀態(tài)，小汽車真實(shí)運(yùn)動(dòng)運(yùn)動(dòng)速度為20m/S。如圖5.6所示：圖5.620m/S卡爾曼濾波的成果圖5.720m/S速度和位置估的方差設(shè)定掃描周期為2秒，初始狀態(tài)，小汽車真實(shí)運(yùn)動(dòng)運(yùn)動(dòng)速度為5m/S。如圖5.8所示：圖5.8雷達(dá)掃描為2S的卡爾曼濾波成果圖5.9雷達(dá)掃描為2S的速度和位置方差設(shè)定掃描周期為3秒，初始狀態(tài)，小汽車真實(shí)運(yùn)動(dòng)運(yùn)動(dòng)速度為5m/S。如圖5.10所示：圖5.10雷達(dá)掃描為3S的卡爾曼濾波成果圖5.11雷達(dá)掃描為3S的速度和位置方差卡爾曼濾波成果的圖中，橫軸表達(dá)小汽車的位置，縱軸表達(dá)小汽車的速度。在卡爾曼濾波的速度和位置的方差圖中，橫軸表達(dá)濾波的次數(shù)，縱軸表達(dá)方差值。通過(guò)分析圖5.2和圖5.4以及圖5.6，發(fā)現(xiàn)針對(duì)于不同運(yùn)動(dòng)速度的小汽車。預(yù)計(jì)的速度曲線和真實(shí)的速度曲線擬合程度都很不錯(cuò)。卡爾曼濾波器就用了極少的幾次迭代就靠近了真實(shí)的速度，并且之后就始終出現(xiàn)在真實(shí)速度的水平范疇，再結(jié)合圖5.3和圖5.5以及圖5.7小汽車的位置和速度方差圖，顯示隨著濾波次數(shù)的增加，不同運(yùn)動(dòng)速度的小汽車位置和速度方差值都在變小，這些都闡明了卡爾曼濾波的高效性。因此得出一種結(jié)論，運(yùn)動(dòng)目的處在低速狀況下，跟蹤的目的速度并不影響卡爾曼濾波器的效率。接著探討雷達(dá)掃描周期對(duì)卡爾曼曼濾波器的影響，通過(guò)對(duì)比圖5.2圖5.8和圖5.10，雷達(dá)掃描周期分別為1秒、2秒、3秒，運(yùn)動(dòng)小汽車速度都為5m/S直線運(yùn)動(dòng)，從曲線擬合角度去看，卡爾曼濾波器仍然很高效的，但是認(rèn)真觀察并且結(jié)合圖5.3圖5.9和圖5.11，發(fā)現(xiàn)隨著雷達(dá)掃描周期的變慢，卡爾曼濾波器效率有些下降，小汽車速度和位置的方差在變大，曲線擬合開(kāi)始變差。由于雷達(dá)掃描周期的變慢，那么采樣的點(diǎn)與點(diǎn)之間存在的不擬定性就在變大，因此雷達(dá)的掃描周期對(duì)卡爾曼濾波器是有著一定的影響?？柭鼮V波的最核心的地方在于由測(cè)量值重新構(gòu)造系統(tǒng)的狀態(tài)向量。它基于先預(yù)測(cè)再進(jìn)行實(shí)測(cè)最后結(jié)合預(yù)測(cè)和實(shí)測(cè)來(lái)修正預(yù)測(cè)值的次序遞推，這樣能夠從帶噪聲的系統(tǒng)中重現(xiàn)系統(tǒng)原來(lái)的樣子。從仿真成果也能夠看得出，卡爾曼濾波器能夠非常有效地在從一定的噪聲干擾條件下系統(tǒng)中相對(duì)比較精確地反映真實(shí)的系統(tǒng)?？柭鼮V波是基于最小均方差預(yù)計(jì)準(zhǔn)則的一套最佳遞推濾波算法，并且卡爾曼濾波的最基本原理是基于被測(cè)信號(hào)與噪聲的空間狀態(tài)分布模型，它結(jié)合了前一時(shí)刻的預(yù)計(jì)值和現(xiàn)在時(shí)刻的觀察值來(lái)更新現(xiàn)在狀態(tài)變量，解出現(xiàn)在時(shí)刻的預(yù)計(jì)值[16]。因此卡爾曼濾波器十分合用實(shí)時(shí)時(shí)刻解決數(shù)據(jù)和計(jì)算機(jī)運(yùn)算。5.4對(duì)運(yùn)動(dòng)目的跟蹤非線性問(wèn)題的初步探討雷達(dá)對(duì)動(dòng)態(tài)目的跟蹤，普通在極（球）坐標(biāo)系統(tǒng)，因此目的相對(duì)于徑向距離的觀察點(diǎn)的觀察量而言，角度和角（也可能獲得觀察到的徑向距離的比值），為了有效地消除噪聲的影響，需要測(cè)量濾波[13]。在對(duì)運(yùn)動(dòng)目的的跟蹤中，例如雷達(dá)領(lǐng)域、聲納和導(dǎo)航等領(lǐng)域，卡爾曼跟蹤濾波器都體現(xiàn)出了其高性能的濾波性能，因此被廣泛得到應(yīng)用。當(dāng)卡爾曼濾波器對(duì)勻速直線運(yùn)動(dòng)目的的跟蹤時(shí)，由于在笛卡兒坐標(biāo)系中的目的狀態(tài)方程是線性的，但是對(duì)目的的觀察往往是在球坐標(biāo)系下進(jìn)行的，因此測(cè)量值是徑向距離，角和傾角，因此目的的狀態(tài)矩陣不是太好通過(guò)線性變化表達(dá)觀察矩陣，因此不能直接使用卡爾曼濾波器。在解決這個(gè)問(wèn)題時(shí)，有種辦法解決，那就是使用卡爾曼濾波器的推廣（EKF）。在使用推廣卡爾曼濾波(extendedkalmanfilter)辦法中，通過(guò)泰勒級(jí)數(shù)展開(kāi)的辦法將球坐標(biāo)系下對(duì)觀察量近似線性化表達(dá)為狀態(tài)函數(shù)后，接著在直角坐標(biāo)系下進(jìn)行運(yùn)動(dòng)目的的狀態(tài)濾波，但是是在球坐標(biāo)系下對(duì)觀察量進(jìn)行預(yù)測(cè)，修正運(yùn)動(dòng)目的的狀態(tài)。因此推廣卡爾曼濾波是一種解析近似非線性濾波，是卡爾曼濾波在非線性系統(tǒng)中的應(yīng)用[13]。相比而言推廣卡爾曼濾波辦法是直接運(yùn)用球坐標(biāo)系下的線性觀察值，不需要對(duì)觀察噪聲進(jìn)行有關(guān)解決，因此相對(duì)比較簡(jiǎn)樸，但是由于是通過(guò)泰勒級(jí)數(shù)展開(kāi)的辦法將球坐標(biāo)系下對(duì)觀察量近似線性化表達(dá)為狀態(tài)函數(shù)的，泰勒級(jí)數(shù)不可能無(wú)限展開(kāi)，總是需要略去高階分量，因此存在精度問(wèn)題，如果跟蹤的運(yùn)動(dòng)目的需要高精度的跟蹤，那么就不能使用推廣卡爾曼濾波的辦法[13]。結(jié)論本次畢業(yè)設(shè)計(jì)是基于Matlab的卡爾曼濾波器在運(yùn)動(dòng)目的跟蹤中的研究以及仿真，采用了蒙特卡洛的數(shù)學(xué)實(shí)驗(yàn)思想，通過(guò)數(shù)學(xué)建模，編寫(xiě)程序進(jìn)行驗(yàn)證了卡爾曼濾波器是一種高效的線性時(shí)域?yàn)V波器。并且分析了運(yùn)動(dòng)目的的速度和位置的方差。其中在第三章中本論文具體介紹了卡爾曼濾波原理，對(duì)卡爾曼濾波器的五個(gè)核心公式做了定性分析。它基于先預(yù)測(cè)再進(jìn)行實(shí)測(cè)最后結(jié)合預(yù)測(cè)和實(shí)測(cè)來(lái)修正預(yù)測(cè)值的次序遞推，這樣能夠從帶噪聲的系統(tǒng)中重現(xiàn)系統(tǒng)原來(lái)的樣子。但是本論文中存在美中局限性之處在于對(duì)運(yùn)動(dòng)目的的建模過(guò)于簡(jiǎn)樸，運(yùn)動(dòng)目的的運(yùn)動(dòng)方式比較單一，只是一種勻速直線運(yùn)動(dòng)，本論文去除了運(yùn)動(dòng)目的的加速度，但是總程序仿真成果來(lái)看，仍然能夠看出卡爾曼濾波器的高效。在測(cè)量過(guò)程中，雷達(dá)只是測(cè)量運(yùn)動(dòng)物體的位置，造成只是個(gè)一維的標(biāo)量。本論文分別研究了卡爾曼濾波器對(duì)不同運(yùn)動(dòng)速度的物體進(jìn)行跟蹤仿真，以及不同雷達(dá)掃描周期對(duì)卡爾曼濾波器的影響，分別對(duì)速度和位置的方差做了分析，總的看來(lái)，卡爾曼濾波器是一種高效的濾波器。本文討論了卡爾曼濾波器在線性系統(tǒng)中的應(yīng)用，并在最后對(duì)卡爾曼濾波器在非線性系統(tǒng)中的應(yīng)用做了初步探討?？柭鼮V波作為一種數(shù)值預(yù)計(jì)濾波的辦法，與應(yīng)用領(lǐng)域的背景結(jié)合性很強(qiáng)。因此在應(yīng)用卡爾曼濾波器解決問(wèn)題時(shí)，重要的不僅僅是實(shí)現(xiàn)算