基於水下信息網絡的多參考節點水下航行器組合導航方法
2024-02-24 19:54:15 1
基於水下信息網絡的多參考節點水下航行器組合導航方法
【專利摘要】本發明公開了一種基於水下信息網絡的多參考節點水下航行器組合導航方法的實現。該方法首先在海水中或者海底部署多個參考網絡節點，節點之間通過水聲modem進行通信。該方法利用位置已知的多個水下網絡節點作為參考節點，通過測定待測目標與多個參考節點之間的距離，從而解算出水下航行器的位置信息，實現水下航行器的定位，然後利用計算所得的位置信息來修正水下航行器配置的捷聯慣導/都卜勒測速導航系統的累積誤差，從而實現高精度的組合導航。本發明可以用來定時修正該導航系統的累積誤差，通過預先設定好修正周期，從而在保證水下航行器隱蔽性以及自主性的基礎上，實現水下航行器的長時間高精度組合導航，具有較高的實際應用價值。
【專利說明】基於水下信息網絡的多參考節點水下航行器組合導航方法
【技術領域】
[0001]本發明是關於導航定位技術，尤其是關於一種基於水下信息網絡的多參考節點水下航行器組合導航系統以及導航定位方法。
【背景技術】
[0002]海洋可以說是人類生存和可持續發展的重要領域，對於海洋的利用以及開發已經成為決定國家興衰的基本因素之一。在海洋的利用以及開發等領域中，由於無線電波在水下衰減比較嚴重，無法滿足水下通信的要求，從而以聲波為載體的水聲通信技術得到了極其廣泛的發展以及應用。
[0003]近幾十年來，水下信息網絡作為無線傳感器網絡技術應用的一大分支，以水聲通信和網絡技術為基礎，在水聲技術的研究領域中進入到全新的發展階段。水下信息網絡，就是部署在水下環境中，以聲波作為信息載體、水聲信道作為通信信道的無線傳感器網絡，是陸地無線傳感器網絡向水下應用的延伸。在水下部署傳感器網絡節點，一方面可以檢測水下環境，進行水下信息的收集，另一方面可以把已知位置的傳感器網絡節點作為參考節點，用來對該海域中的水下航行器等進行定位，從而輔助水下航行器實現高精度導航。
[0004]要使水下航行器完成一些預定的任務以及使命，自然離不開水下導航技術。和陸地導航以及空中導航相比，水下導航具有工作時間長、隱蔽性要求高、環境複雜以及信息源少等特點，因此相對於陸地導航以及空中導航，水下導航的研究和應用具有更大的難度。
[0005]目前，將水下信息網絡和目標定位技術結合在一起，是水聲定位技術的新興研究方向。對檢測區域的目標進行定位是水下信息網絡眾多應用的一個關鍵技術，也是其他應用的基礎。
[0006]本發明中，把多個已知位置信息的水下信息網絡節點作為參考節點，用來對該海域中的水下航行器進行定位，並利用定位結果來定時修正水下航行器SINS/DVL導航系統的累積誤差，從而實現水下航行器長時間的高精度自主導航。
[0007]利用水下信息網絡節點來實現監測海域的目標定位，同時與水下航行器自身配置的SINS/DVL導航系統相結合，從而修正SINS/DVL導航系統的累積誤差，實現高精度的組合導航，這在水下導航定位研究中，有著長足的意義。
【發明內容】
[0008]本發明的技術解決問題是:克服現有技術的不足，提供一種長時間的高精度自主組合導航方法，該方法能夠大大提高長時間航行的水下航行器的導航精度，並具有自主性。
[0009]本發明為實現上述發明目的採用如下技術方案:
[0010]一種基於水下信息網絡的多參考節點水下航行器組合導航方法，包括如下步驟:
[0011]A，水下航行器在水下航行全程中通過自身裝配的SINS/DVL導航系統進行導航。SINS/DVL導航系統可以對水下航行器進行短時間的高精度導航定位，但是隨著時間的推移，存在一定的累積誤差。對於長時間航行的水下航行器，SINS/DVL導航系統存在一定的導航偏差，需要定時引入其他定位系統進行輔助導航定位，從而修正此導航系統的導航累積誤差，實現長時間的高精度自主導航。
[0012]其中，SINS/DVL導航系統原理為:
[0013]綜合SINS系統與DVL系統的誤差模型，建立SINS/DVL系統的狀態方程以及量測方程，利用卡爾曼濾波進行該系統的最優估計，從而實現SINS/DVL導航系統的導航。
[0014]B,由於長時間航行之後，SINS/DVL導航系統存在一定的累積誤差,故需要定時對其進行輔助定位，利用輔助定位結果修正導航累積誤差，定位過程如下:
[0015]水下航行器航行過程中，每隔一段時間，通過水下航行器上的測距平臺，與多個參考網絡節點之間完成通信測距，從而獲得時延差，算出距離信息，利用這多個距離信息，解算出水下航行器的位置信息，實現水下航行器的定位。
[0016]步驟B中的一種通信測距的方法，本發明中採用雙向通信測距的方法完成參考點與待測點之間的水聲測距，具體步驟為:
[0017]首先，待測點水聲modem產生由信息碼和同步頭信號組成的定位脈衝，經調製後，向水下參考點(位置已知)發射此定位脈衝信號，此發送信號中包含發送時間tl，當水下參考點收到該信號時，進行同步解調，並利用同步過程得到信號傳輸時延差τ?，並把τ?和收到的信號一起重新調製，變頻回發給待測節點作為應答，此回發信號中還包含回發時間t3和參考點的深度信息，待測點換能器收到此回發信號時，再進行同步解調，得到此次的傳輸時延差τ 2，同時解調得到τ 1，在通信測距過程中，信號傳輸時延差τ 1、τ 2，通過LFM信號求相關檢測求得。
[0018]設信號發射端與接收端的時間誤差為Λ τ，發送節點與接收節點之間的單向時延差為τ。由信號處理過程，可得如下時間關係:
【權利要求】
1.一種基於水下信息網絡的多參考節點水下航行器組合導航方法，其包括如下步驟: A，水下航行器在水下航行全程中通過自身裝配的捷聯慣導/都卜勒測速SINS/DVL導航系統進行粗導航； B，定時對所述水下航行器進行輔助定位，所述定位過程如下: 水下航行器航行過程中，每隔一段時間，通過水下航行器上的測距平臺，與多個參考網絡節點之間完成通信測距，從而獲得時延差，算出距離信息，利用這多個距離信息，解算出水下航行器的位置信息，實現水下航行器的定位； C，定時對水下航行器進行定位運算，利用定位所得的位置信息來修正水下航行器配置的SINS/DVL導航系統的累積誤差，從而實現高精度的組合導航。
2.根據權利要求1所述的一種基於水下信息網絡的多參考節點水下航行器組合導航方法，其特徵在於: 所述步驟A中的SINS/DVL導航系統是綜合SINS系統與DVL系統的誤差模型，建立SINS/DVL系統的狀態方程以及量測方程，利用卡爾曼濾波進行該系統的最優估計，從而實現SINS/DVL導航系統的粗導航。
3.根據權利要求1所述的一種基於水下信息網絡的多參考節點水下航行器組合導航方法，其特徵在於: 所述步驟B中的通信測距的具體步驟包括: 待測點水聲modem產生由信息碼和同步頭信號組成的定位脈衝，經調製後，向水下參考點發射此定位脈衝信號，其中所述水下參考點的位置已知，此發送信號中包含發送時間tl ； 當水下參考點收到該信號時，進行同步解調，並利用同步過程得到信號傳輸時延差τ i，並把τ i和收到的信號一起重新調製，變頻回發給待測節點作為應答，此回發信號中還包含回發時間t3和參考點的深度信息； 待測點換能器收到此回發信號時，再進行同步解調，得到此次的傳輸時延差τ2，同時解調得到τ i ； 在通信測距過程中，信號傳輸時延差H、τ2，通過LFM信號求相關檢測求得； 設信號發射端與接收端的時間誤差為△ τ，發送節點與接收節點之間的單向時延差為τ，通過信號處理過程，可得如下時間關係:
由上式可得:
再將得到的時延差τ，乘以該水域的等效平均聲速，得到兩點之間的距離，完成測距。
4.根據權利要求1所述的一種基於水下信息網絡的多參考節點水下航行器組合導航方法，其特徵在於:所述步驟B中的定位過程，具體包括以下步驟: 假設有η個已知的參考點位置信息，其中n>3，參考點採用統一的時鐘系統，故待測目標與參考網絡節點之間的距離可以表示為:
(Ii = c τ j (3)
i = 1，2，…，η 其中，Cli表示待測目標與第i個參考點之間的距離，c為聲波在水中的等效平均傳播速度，τ i為待測目標與第i個參考點之間的時延差，通過雙向通信測距測得，又有:
(Ii2 = (X1-X)2+(Yry)i^(Z1-Z)2 (4) 其中，(Xi, Yi, Zi)為第i個參考點的坐標,為已知量，(x，y，z)為待測目標的坐標，z坐標值通過深度傳感器測得，將式(3)代入式(4)中，同時展開，得:
將式(5)括號展開後，並用式(5)中的後面η-l項分別減去第一項，整理之後，可以得到如下線性方程組:
整理，得如下表達式:
將其寫成矩陣形式: CX = D (8) 其中: X = [X y]T (9)
因為方程組CX = D中，C中的變量為已知信息，可以認為不存在誤差擾動，而D中的時延差變量τ需要通過測量得到，存在誤差擾動，滿足最小二乘的前提條件，故可以利用最小二乘法，得到方程組的解為: X=(CtC)-1CtD (12) 通過以上公式，可以由一組實測時延差，以及參考點的位置信息，從而求得待測點的位置信息，實現定位。
5.根據權利要求1所述的一種基於水下信息網絡的多參考節點水下航行器組合導航方法，其特徵在於: 步驟C中定時修正SINS/DVL導航系統的累積誤差，具體包括以下步驟: 利用SINS/DVL導航系統進行導航，長時間航行之後累積誤差增大，定時對水下航行器進行定位運算，利用定位過程求得的待測點的位置信息對SINS/DVL導航系統的累積誤差進行修正，從而實現高精度的自主組合導航。
【文檔編號】G01C21/18GK104197939SQ201410462889
【公開日】2014年12月10日 申請日期:2014年9月11日 優先權日:2014年9月11日
【發明者】高翔, 周雲 申請人:東南大學