無人機技術(shù)原理19課件

無人機技術(shù)原理第五章無人機的導(dǎo)航技術(shù)慣性導(dǎo)航技術(shù)1.無人機慣性導(dǎo)航背景

在無人機導(dǎo)航系統(tǒng)中，慣性導(dǎo)航系統(tǒng)被認(rèn)為是最重要的一種導(dǎo)航系統(tǒng)。慣性導(dǎo)航是以測量運動體加速度為基礎(chǔ)的導(dǎo)航定位方法，測量到的加速度經(jīng)過一次積分可以得到運動速度，經(jīng)過二次積分可以得到運動距離，從而給出運動體的瞬時速度和位置數(shù)據(jù)。這種不依賴外界信息，只靠載體自身的慣性測量來完成導(dǎo)航任務(wù)的技術(shù)也叫自主式導(dǎo)航。慣性導(dǎo)航系統(tǒng)就是一種利用慣性敏感器件、基準(zhǔn)方向及最初的位置信息來確定運載體在慣性空間中的位置、方向和速度的自主式導(dǎo)航系統(tǒng)，有時也簡稱為慣導(dǎo)。2.無人機慣性導(dǎo)航原理和組成假設(shè)物體做勻速或變速直線運動，其瞬時位置都取決于初始位置、速度的大小和作用的時間，而速度則取決于初始速度、加速度的大小和作用的時間。也就是說，位置是對速度的積分，速度是對加速度的積分。3.陀螺儀凡能繞定點高速旋轉(zhuǎn)的物體，都可以成為陀螺。利用陀螺的力學(xué)性質(zhì)所制成的各種功能的陀螺裝置稱為陀螺儀。4.加速度計凡能繞定點高速旋轉(zhuǎn)的物體，都可以成為陀螺。利用陀螺的力學(xué)性質(zhì)所制成的各種功能的陀螺裝置稱為陀螺儀。5.平臺式慣性導(dǎo)航系統(tǒng)平臺式慣性導(dǎo)航系統(tǒng)是將陀螺儀和加速度等慣性元件通過萬向支架角運動隔離系統(tǒng)與運動載物固聯(lián)的慣性導(dǎo)航系統(tǒng)。慣性導(dǎo)航技術(shù)6.捷聯(lián)式慣性導(dǎo)航系統(tǒng)

捷聯(lián)慣導(dǎo)系統(tǒng)（SINS）是在平臺式慣導(dǎo)系統(tǒng)基礎(chǔ)上發(fā)展而來的，它是一種無框架系統(tǒng)，由三個速率陀螺、三個線加速度計和微型計算機組成。捷聯(lián)式慣性導(dǎo)航系統(tǒng)原理圖衛(wèi)星定位導(dǎo)航技術(shù)

衛(wèi)星導(dǎo)航是借助在預(yù)定空間軌道上運行的人造衛(wèi)星而進行的一種導(dǎo)航技術(shù)。在衛(wèi)星導(dǎo)航中，用戶通過測定其相對于衛(wèi)星的位置可以確定自己在地球上的位置。1.GPS系統(tǒng)2.GLONASS系統(tǒng)GLONASS衛(wèi)星導(dǎo)航定位系統(tǒng)是在20世紀(jì)70年代美蘇兩霸冷戰(zhàn)競爭時代開始研制的，經(jīng)過20多年努力，于1995年建成。GLONASS系統(tǒng)空中有24顆衛(wèi)星3.GALILEO系統(tǒng)GALILEO計劃是由歐盟發(fā)起，歐盟和歐空局（ESA）共同負(fù)責(zé)的民用衛(wèi)星導(dǎo)航服務(wù)計劃，旨在建立一個民用全球衛(wèi)星導(dǎo)航服務(wù)系統(tǒng)。GPS全球定位系統(tǒng)的空間星座由24顆工作衛(wèi)星構(gòu)成（BlockII，其中3顆為備用衛(wèi)星）。4.北斗衛(wèi)星導(dǎo)航系統(tǒng)北斗衛(wèi)星導(dǎo)航系統(tǒng)是中國自行研制的全球衛(wèi)星定位與通信系統(tǒng)（BDS），是繼美國GPS和GLONASS之后第三個成熟的衛(wèi)星導(dǎo)航系統(tǒng)。視覺導(dǎo)航技術(shù)1.視覺里程計（VisualOdometry，VO）2.特征匹配3.根據(jù)匹配好的特征點估計相機運動4.重建5.直接法（DirectMethods）組合導(dǎo)航技術(shù)組合導(dǎo)航系統(tǒng)是將無人機上的導(dǎo)航設(shè)備組合成一個統(tǒng)一的系統(tǒng)，利用兩種或兩種以上的設(shè)備提供多重信息，構(gòu)成一個多功能、高精度的冗余系統(tǒng)。組合導(dǎo)航的優(yōu)勢體現(xiàn)在以下幾個方面：1)協(xié)作互補功能。綜合各子系統(tǒng)的導(dǎo)航信息，取長補短，形成單個子系統(tǒng)不具備的功能和精度，提升導(dǎo)航信息輸出頻率，擴大系統(tǒng)的使用范圍。2)余度功能。各個系統(tǒng)觀測同一信息源，測量值冗余度大，增強了導(dǎo)航系統(tǒng)的可靠性與穩(wěn)定性。組合導(dǎo)航技術(shù)

大多數(shù)GPS/INS組合系統(tǒng)都采用松組合或緊組合方式。兩者的區(qū)別在于：在松組合中，GPS提供的量測信息是位置和速度等最終導(dǎo)航結(jié)果，由于GPS的位置和速度通常是相關(guān)的（在GPS接收機內(nèi)部采用卡爾曼濾波器的情況下尤為嚴(yán)重），使組合濾波器的估計精度受到影響，并且當(dāng)導(dǎo)航星少于4顆而無法定位解算時，系統(tǒng)的組合將被完全破環(huán)，整個導(dǎo)航系統(tǒng)性能就會迅速惡化；而緊組合中，GPS提供的量測信息是偽距、偽距率和多普勒頻率等接收機用于定位的原始信息，克服了松組合方式中量測信息的相關(guān)性問題，提高了組合系統(tǒng)的導(dǎo)航精度，且當(dāng)可用星數(shù)目不足4顆時，也可以進行導(dǎo)航。松組合與緊組合方式的實質(zhì)都是GPS對INS的輔助，缺少對GPS接收機的輔助，當(dāng)組合系統(tǒng)中GPS接收機跟蹤性能下降時，會影響組合系統(tǒng)的導(dǎo)航性能。超緊組合方式則是對INS、GPS進行更深層次的信息融合，一方面為INS提供誤差校正信息以提高導(dǎo)航精度，另一方面利用校正后的INS量測信息為GPS跟蹤環(huán)路提供輔助信息。隨著航空、航天、軍事等應(yīng)用對導(dǎo)航系統(tǒng)的高動態(tài)、抗干擾等性能要求的提升，超緊組合導(dǎo)航技術(shù)逐步成為國內(nèi)外研究的重點。導(dǎo)航系統(tǒng)的組合方式介紹組合導(dǎo)航技術(shù)

超緊組合是一種在硬件級進行一體化的組合方式，除了通過估計INS誤差對INS進行反饋校正外，還使用校正后INS信息對GPS接收機的載波環(huán)、碼環(huán)進行輔助或直接用INS信息閉合載波環(huán)和碼環(huán)跟蹤環(huán)路。超緊組合一體化在實現(xiàn)方式上分為兩種：一種是在傳統(tǒng)標(biāo)量接收機的內(nèi)部，INS輔助接收機碼環(huán)或載波跟蹤環(huán)路，輔助后的接收機再與INS采用緊組合方式組合；另一種是用矢量跟蹤環(huán)路代替?zhèn)鹘y(tǒng)的GPS接收機跟蹤環(huán)路，并用組合濾波器代替矢量跟蹤接收機中的導(dǎo)航濾波器。第一種超緊組合方式通常稱為INS輔助GPS超緊組合，但在實際應(yīng)用中普遍認(rèn)為，只要INS能夠輔助衛(wèi)星信號的捕獲和跟蹤，就可以將兩者之間的組合方式稱為超緊組合。第二種超緊組合方式稱為基于矢量跟蹤環(huán)路的GPS/INS超緊組合，我們將這種矢量跟蹤超緊組合稱為深組合。GPS/INS深組合算法又可以根據(jù)接收機與卡爾曼濾波器之間信息流動方式的不同分為兩類：相關(guān)算法和非相關(guān)算法。相關(guān)算法是把GPS相關(guān)累加器輸出的I，Q信號直接作為卡爾曼濾波器的量測信息；而非相關(guān)算法是先將I，Q信號經(jīng)傳統(tǒng)跟蹤環(huán)路中的碼相位和載波鑒頻器處理，然后再作為卡爾曼濾波器的量測信息。下面將對INS輔助GPS超緊組合、相關(guān)深組合和非相關(guān)深組合的結(jié)構(gòu)、特點以及國內(nèi)外研究動態(tài)分別進行對比分析。GPS／INS超緊組合系統(tǒng)概念與分類組合導(dǎo)航技術(shù)1.INS輔助GPS超緊組合模式INS輔助GPS超緊組合是最簡單的超緊組合模式，只需在緊組合系統(tǒng)結(jié)構(gòu)的基礎(chǔ)上，利用組合導(dǎo)航濾波器對載體多普勒頻率進行估計，并將估計結(jié)果輸送到接收機內(nèi)部對跟蹤環(huán)路進行輔助。不同GPS／INS超緊組合模式結(jié)構(gòu)2.GPS/INS深組合模式GPS/INS深組合模式是基于GPS矢量跟蹤結(jié)構(gòu)提出的，它將GPS信號的跟蹤與GPS/INS信息組合功能集中在一個單獨的估計算法中，而INS輔助GPS超緊組合是以傳統(tǒng)標(biāo)量跟蹤結(jié)構(gòu)為基礎(chǔ)的。3.GPS/INS相關(guān)深組合模式根據(jù)組合導(dǎo)航卡爾曼濾波器結(jié)構(gòu)的不同，相關(guān)深組合可以分為集中濾波相關(guān)深組合和級聯(lián)濾波相關(guān)深組合。來自GPS接收機的I、Q信號直接作為組合導(dǎo)航卡爾曼濾波器的量測信息。由于集中濾波相關(guān)深組合模式存在計算負(fù)擔(dān)重、狀態(tài)方程可觀測性差、數(shù)據(jù)跳變等缺點，因此，對于所有實際實現(xiàn)的相關(guān)深組合系統(tǒng)都采用了級聯(lián)卡爾曼濾波結(jié)構(gòu)。4.GPS/INS非相關(guān)深組合模式非相關(guān)深組合中，I、Q信息不需要數(shù)據(jù)清除，而是直接通過與傳統(tǒng)跟蹤環(huán)中鑒別器相似的鑒別器模塊計算碼相位和載波頻率偏差。隨后這些偏差經(jīng)求和與比例運算得到頻率為1-2Hz的偽距、偽距率信息，這些信息直接作為組合導(dǎo)航濾波器的量測量。為了估計碼相位偏差，相關(guān)深組合算法中必須估計出載波相位偏差，而非相關(guān)深組合由于碼相位鑒別功能獨立于載波相位鑒別器，因此不需要估計載波相位偏差。組合導(dǎo)航技術(shù)1.INS輔助GPS超緊組合模式

從INS輔助GPS超緊組合模式的結(jié)構(gòu)中可以看到，INS的輔助反饋中包含的載體動態(tài)信息，不僅可以減小GPS接收機碼環(huán)和載波所跟蹤載體的動態(tài)，從而減小碼環(huán)和載波環(huán)的等效帶寬，提高整個系統(tǒng)在高動態(tài)環(huán)境下的抗干擾能力，還可以降低環(huán)路濾波器的帶寬，達(dá)到抑制熱噪聲的目的，這就有效解決了傳統(tǒng)跟蹤環(huán)設(shè)計中存在的動態(tài)跟蹤性能與抗干擾能力之間的矛盾。因此，與緊組合導(dǎo)航方式相比，接收機動態(tài)性能和抗干擾性能有了很大的改善；在硬件實現(xiàn)上，對傳統(tǒng)GPS接收機的結(jié)構(gòu)改造小，可操作性強。但是對于這種結(jié)構(gòu)，如果采用低水平的INS，如MEMS-IMU，當(dāng)載體高動態(tài)運動或受到強干擾時，可能會造成跟蹤環(huán)路不能有效跟蹤多普勒頻率誤差的快速變化，進而使跟蹤環(huán)路失鎖、組合濾波器變得不穩(wěn)定。另外，由于輔助跟蹤環(huán)的結(jié)構(gòu)中存在濾波器級聯(lián)，當(dāng)環(huán)路濾波器帶寬小于卡爾曼濾波器的有效帶寬時，輔助構(gòu)型會變得不穩(wěn)定。其次，每個衛(wèi)星信號都采用獨立的跟蹤環(huán)進行跟蹤，因此對跟蹤環(huán)路數(shù)控震蕩器（NCO）的控制不能充分利用已有的導(dǎo)航信息進行輔助，這會影響跟蹤環(huán)路在強噪聲和超高動態(tài)環(huán)境中的跟蹤能力。不同超緊組合模式特點2.GPS/INS深組合模式GPS/INS深組合模式與INS輔助GPS超緊組合模式相比，其優(yōu)點為：1)深組合導(dǎo)航系統(tǒng)基于矢量跟蹤結(jié)構(gòu)，提高了GPS接收機在較低信噪比環(huán)境（信號衰減、受到偶然或故意干擾等）中的信號跟蹤性能。2)一般INS輔助GPS超緊組合的跟蹤環(huán)路帶寬不能隨著載噪比水平的變化而進行調(diào)節(jié)，而優(yōu)化的深組合算法會根據(jù)載噪比水平調(diào)節(jié)跟蹤環(huán)路帶寬，這樣就增強了系統(tǒng)在受干擾情況下的導(dǎo)航性能。3)在GPS信號出現(xiàn)短暫中斷后，深組合系統(tǒng)可以不需要重捕獲而保持連續(xù)跟蹤；INS輔助GPS超緊組合系統(tǒng)則仍需要進行信號的重捕獲。4)INS輔助GPS超緊組合系統(tǒng)中存在濾波器串聯(lián)，為了避免組合導(dǎo)航不穩(wěn)定，實際使用中，需要對組合導(dǎo)航濾波器的噪聲帶寬進行限制，以保證其小于跟蹤環(huán)路帶寬。而深組合系統(tǒng)去除了這種串聯(lián)，使其有了更好的導(dǎo)航性能。組合導(dǎo)航技術(shù)不同超緊組合模式特點2.GPS/INS深組合模式GPS/INS深組合模式與INS輔助GPS超緊組合模式相比，其優(yōu)點為：1)深組合導(dǎo)航系統(tǒng)基于矢量跟蹤結(jié)構(gòu)，提高了GPS接收機在較低信噪比環(huán)境（信號衰減、受到偶然或故意干擾等）中的信號跟蹤性能。2)一般INS輔助GPS超緊組合的跟蹤環(huán)路帶寬不能隨著載噪比水平的變化而進行調(diào)節(jié)，而優(yōu)化的深組合算法會根據(jù)載噪比水平調(diào)節(jié)跟蹤環(huán)路帶寬，這樣就增強了系統(tǒng)在受干擾情況下的導(dǎo)航性能。3)在GPS信號出現(xiàn)短暫中斷后，深組合系統(tǒng)可以不需要重捕獲而保持連續(xù)跟蹤；INS輔助GPS超緊組合系統(tǒng)則仍需要進行信號的重捕獲。4)INS輔助GPS超緊組合系統(tǒng)中存在濾波器串聯(lián)，為了避免組合導(dǎo)航不穩(wěn)定，實際使用中，需要對組合導(dǎo)航濾波器的噪聲帶寬進行限制，以保證其小于跟蹤環(huán)路帶寬。而深組合系統(tǒng)去除了這種串聯(lián)，使其有了更好的導(dǎo)航性能。3.GPS/INS相關(guān)深組合模式根據(jù)組合導(dǎo)航卡爾曼濾波器結(jié)構(gòu)的不同，相關(guān)深組合可以分為集中濾波相關(guān)深組合和級聯(lián)濾波相關(guān)深組合。來自GPS接收機的I、Q信號直接作為組合導(dǎo)航卡爾曼濾波器的量測信息。由于集中濾波相關(guān)深組合模式存在計算負(fù)擔(dān)重、狀態(tài)方程可觀測性差、數(shù)據(jù)跳變等缺點，因此，對于所有實際實現(xiàn)的相關(guān)深組合系統(tǒng)都采用了級聯(lián)卡爾曼濾波結(jié)構(gòu)。4.GPS/INS非相關(guān)深組合模式非相關(guān)深組合中，I、Q信息不需要數(shù)據(jù)清除，而是直接通過與傳統(tǒng)跟蹤環(huán)中鑒別器相似的鑒別器模塊計算碼相位和載波頻率偏差。隨后這些偏差經(jīng)求和與比例運算得到頻率為1-2Hz的偽距、偽距率信息，這些信息直接作為組合導(dǎo)航濾波器的量測量。為了估計碼相位偏差，相關(guān)深組合算法中必須估計出載波相位偏差，而非相關(guān)深組合由于碼相位鑒別功能獨立于載波相位鑒別器，因此不需要估計載波相位偏差。組合導(dǎo)航技術(shù)各種GPS／INS組合方式性能對比量的名稱松組合緊組合INS輔助GPS超緊組合相關(guān)深組合非相關(guān)深組合捕獲能力一般一般好好好再捕獲能力一般一般良好好好定位精度一般良好好很好好弱信號或強干擾差一般良好好很好實現(xiàn)難度很小小一般稍大稍大系統(tǒng)成本較高，必須使用高精度IMU較高，必須使用高精度IMU較低，可以采用低質(zhì)量MEMSIMU較低，可以采用低質(zhì)量MEMSIMU較低，可以采用低質(zhì)量MEMSIMU其他INS、GPS相互獨立INS、GPS獨立性減小INS、GPS超緊耦合，跟蹤環(huán)相互獨立INS、GPS超緊耦合，根治環(huán)相互影響INS、GPS超緊耦合，根治環(huán)相互影響不同組合方式性能比較組合導(dǎo)航技術(shù)北斗/慣導(dǎo)深組合導(dǎo)航算法在所有的組合導(dǎo)航系統(tǒng)中，以北斗與慣性導(dǎo)航系統(tǒng)INS組合的系統(tǒng)最為理想，而深組合方式是北斗與慣性導(dǎo)航系統(tǒng)組合的最優(yōu)方法。鑒于GPS

的不可依賴性，北斗衛(wèi)星導(dǎo)航系統(tǒng)與INS的組合是我國組合導(dǎo)航系統(tǒng)的發(fā)展趨勢，我國自主研制北斗/INS深組合導(dǎo)航系統(tǒng)需要解決的關(guān)鍵技術(shù)。深組合導(dǎo)航算法是由INS導(dǎo)航結(jié)果推算出偽距、偽距率，與北斗定位系統(tǒng)觀測得到的偽距、偽距率作差得到觀測量。通過卡爾曼濾波對INS的誤差和北斗接收機的誤差進行最優(yōu)估計，并根據(jù)估計出的INS誤差結(jié)果對INS進行反饋校正，使INS保持高精度的導(dǎo)航。同時利用校正后的INS速度信息對北斗接收機的載波環(huán)、碼環(huán)進行輔助跟蹤，消除載波跟蹤環(huán)和碼跟蹤環(huán)中載體的大部分動態(tài)因素，以降低載波跟蹤環(huán)和碼跟蹤環(huán)的階數(shù)，從而減小環(huán)路的等效帶寬，增加北斗接收機在高動態(tài)或強干擾環(huán)境下的跟蹤能力。其組合方式如圖所示，圖中只畫出了北斗的一個通道，其他通道均相同。組合