[發明專利]基于多源信息自適應融合的無人機導航系統及方法有效
| 申請號: | 201710805226.2 | 申請日: | 2017-09-08 |
| 公開(公告)號: | CN107576977B | 公開(公告)日: | 2020-11-03 |
| 發明(設計)人: | 羅兵;逯亮清;胡寶軍;何磊 | 申請(專利權)人: | 北京韋加無人機科技股份有限公司 |
| 主分類號: | G01S19/45 | 分類號: | G01S19/45;G01S19/46 |
| 代理公司: | 北京正鼎專利代理事務所(普通合伙) 11495 | 代理人: | 岳亞 |
| 地址: | 102615 北京市大*** | 國省代碼: | 北京;11 |
| 權利要求書: | 查看更多 | 說明書: | 查看更多 |
| 摘要: | |||
| 搜索關鍵詞: | 基于 信息 自適應 融合 無人機 導航系統 方法 | ||
1.一種基于多源信息自適應融合的無人機導航方法,包括:
利用多個傳感器分別檢測的當前時刻無人機在X軸、Y軸、Z軸三個方向上的多個參考位置信息,X軸方向、Y軸方向、Z軸方向均對應有一個或多個所述傳感器,且X軸、Y軸、Z軸三個方向中至少一個方向對應有多個所述傳感器;
分別計算X軸、Y軸、Z軸三個方向上每個所述傳感器檢測的所述參考位置信息與估計位置信息之間的差值,得到X軸、Y軸、Z軸三個方向上每個所述傳感器檢測的每個所述參考位置信息與所述估計位置信息的位置誤差;
針對同一方向對應有多個所述傳感器的情況,根據每個所述傳感器對應的所述位置誤差自適應分配出該方向上每個所述傳感器的信息融合權重,對同一方向上對應有多個所述傳感器中的每個所述傳感器在該方向上的所述位置誤差按照所述權重進行加權求和得到該方向上的位置總誤差;
設計X軸、Y軸、Z軸三個方向對應的三階鎖相環濾波器;
針對同一方向對應有一個所述傳感器的情況,利用所述三階鎖相環濾波器,根據該方向對應的所述位置誤差計算無人機在該方向上的估計加速度信息及估計的前一時刻的速度信息;針對同一方向對應有多個所述傳感器的情況,利用所述三階鎖相環濾波器,根據該方向對應的所述位置總誤差計算所述無人機在該方向上的估計加速度信息及估計的前一時刻的速度信息;
設計速度-位移預測模型,利用所述速度-位移預測模型,根據所述估計加速度信息及所述估計的前一時刻的速度信息計算當前時刻估計的速度信息及所述估計位置信息;
其中,根據每個所述傳感器對應的所述位置誤差自適應分配出該方向上每個所述傳感器的信息融合權重,對同一方向上具有的多個所述傳感器中的每個所述傳感器在該方向上的所述位置誤差按照所述權重進行加權求和得到該方向上的位置總誤差的步驟具體包括:
對每個所述位置誤差的絕對值求倒數,即為其中,errDm為具有多個所述傳感器的D方向對應的第m個位置誤差,D方向為X軸、Y軸、或Z軸對應的方向;
根據所述每個位置誤差的絕對值倒數以及所述每個位置誤差對應的所述傳感器的先驗信息權重自適應分配出相應傳感器的信息融合權重,記為KDm,計算公式如下:
其中,KDm為具有i個所述傳感器的D方向對應的第m個所述傳感器在D方向上的權重,i等于或大于2,RDm為D方向對應的第m個所述傳感器的先驗信息權重;
具有多個所述傳感器的D方向的位置總誤差的計算公式為:
errposD=KD1errD1+KD2errD2+KKDmerrDm+K+KDierrDi。
2.根據權利要求1所述的無人機導航方法,其中
若所述位置誤差的絕對值的倒數大于預設閾值時,將所述位置誤差的絕對值的倒數記為所述預設閾值。
3.根據權利要求1所述的無人機導航方法,其中
每個所述三階鎖相環濾波器的三個支路的系數分別為C1、C2、C3,其中,C1支路的輸出為out1pll=errpos×C1,C2支路的輸出為out2pll=errpos×C2,C3支路的輸出為out3pll=∫(errpos×C3)dt,其中errpos表示所述位置誤差或所述位置總誤差。
該專利技術資料僅供研究查看技術是否侵權等信息,商用須獲得專利權人授權。該專利全部權利屬于北京韋加無人機科技股份有限公司,未經北京韋加無人機科技股份有限公司許可,擅自商用是侵權行為。如果您想購買此專利、獲得商業授權和技術合作,請聯系【客服】
本文鏈接:http://www.szxzyx.cn/pat/books/201710805226.2/1.html,轉載請聲明來源鉆瓜專利網。
- 上一篇:一種醫療輸液瓶回收裝置
- 下一篇:一種塑料瓶口自動切除機
- 同類專利
- 專利分類
G01S 無線電定向;無線電導航;采用無線電波測距或測速;采用無線電波的反射或再輻射的定位或存在檢測;采用其他波的類似裝置
G01S19-00 衛星無線電信標定位系統;利用這種系統傳輸的信號確定位置、速度或姿態
G01S19-01 .傳輸時間戳信息的衛星無線電信標定位系統,例如,GPS [全球定位系統]、GLONASS[全球導航衛星系統]或GALILEO
G01S19-38 .利用衛星無線電信標定位系統傳輸的信號來確定導航方案
G01S19-39 ..傳輸帶有時間戳信息的衛星無線電信標定位系統,例如GPS [全球定位系統], GLONASS [全球導航衛星系統]或GALILEO
G01S19-40 ...校正位置、速度或姿態
G01S19-42 ...確定位置
- 信息記錄介質、信息記錄方法、信息記錄設備、信息再現方法和信息再現設備
- 信息記錄裝置、信息記錄方法、信息記錄介質、信息復制裝置和信息復制方法
- 信息記錄裝置、信息再現裝置、信息記錄方法、信息再現方法、信息記錄程序、信息再現程序、以及信息記錄介質
- 信息記錄裝置、信息再現裝置、信息記錄方法、信息再現方法、信息記錄程序、信息再現程序、以及信息記錄介質
- 信息記錄設備、信息重放設備、信息記錄方法、信息重放方法、以及信息記錄介質
- 信息存儲介質、信息記錄方法、信息重放方法、信息記錄設備、以及信息重放設備
- 信息存儲介質、信息記錄方法、信息回放方法、信息記錄設備和信息回放設備
- 信息記錄介質、信息記錄方法、信息記錄裝置、信息再現方法和信息再現裝置
- 信息終端,信息終端的信息呈現方法和信息呈現程序
- 信息創建、信息發送方法及信息創建、信息發送裝置





