国产日韩欧美一区二区三区三州_亚洲少妇熟女av_久久久久亚洲av国产精品_波多野结衣网站一区二区_亚洲欧美色片在线91_国产亚洲精品精品国产优播av_日本一区二区三区波多野结衣 _久久国产av不卡

?

超短基線定位系統(tǒng)在沉管測控中的應用

2019-12-25 06:12趙心1喻敏丁賢君
船海工程 2019年6期
關鍵詞:應答器位姿基線

趙心1,喻敏,丁賢君

(1.中國船舶工業(yè)系統(tǒng)工程研究院,北京 100036;2.武漢理工大學 交通學院,武漢 430063)

隨著水上交通的發(fā)展,單一的沉管定位方法已經(jīng)很難滿足施工的需求,隨著沉管的施工環(huán)境向遠岸、深水發(fā)展,將多種定位方法[1-2]進行組合,集合成綜合定位系統(tǒng)已成為現(xiàn)代沉管隧道沉放定位技術的主流[3-4]。其中,將水聲定位技術與廣域差分GPS定位技術相結合,可獲取沉管的大地坐標,且受環(huán)境因素影響較小,無需安裝測量塔,已成為解決深水沉管隧道管節(jié)沉放的有效途徑。

提出將沉管沉放定位分為兩個階段:粗測階段及精測階段。在粗測階段,將超短基線(USBL)聲學定位系統(tǒng)與GPS組合,對下沉階段的管節(jié)位姿進行實時測量,引導待沉管節(jié)沉放至預定位置,省去測量塔的安裝,提高施工深度;在精測階段,由精測定位系統(tǒng)(如超聲波定位[5],機械定位[6])完成沉管最終對接。本文重點圍繞粗測階段,詳細給出基于水聲定位系統(tǒng)和GPS定位系統(tǒng)的沉管定位方案。

1 沉管定位方案

1.1 方案布置

針對待沉管道下沉施工階段,提出基于超短基線定位系統(tǒng)對待沉管節(jié)姿態(tài)進行實時測控。安裝在施工平臺(如駁船)舷側的超短基線系統(tǒng)以聲波作為載體,對固定在待沉管節(jié)表面的應答器進行定位。駁船上安裝有GPS天線以及姿態(tài)傳感器,用于將超短基線坐標系下的定位信息轉換到大地坐標中。因此,需要建立3個坐標系:以GPS天線為原點的大地坐標系、以駁船重心為原點的船心坐標系和以超短基線基陣中心為原點的基陣坐標系,通過姿態(tài)傳感器測量的船姿態(tài)信息及GPS天線的大地坐標,根據(jù)歐拉旋轉矩陣對3個坐標系進行轉換,最終可獲取待沉沉管在大地坐標系中的位姿信息。見圖1。

圖1 基于USBL定位系統(tǒng)的沉管定位方案

從管節(jié)下沉開始,位于沉管上表面的應答器便不間斷地發(fā)射預置脈沖信號,基陣持續(xù)接收脈沖信號。超短基線系統(tǒng)根據(jù)基陣陣元間的相位差解算出應答器在基陣坐標系中的位置,并通過位姿解算方法獲得沉管的位姿信息。然后通過坐標轉換獲取沉管在大地坐標系中的絕對位姿信息。最終,顯示器實時顯示沉管在大地坐標系中的三維位姿,對現(xiàn)場施工進行連續(xù)監(jiān)控。

1.2 位姿解算

已知應答器安裝在待沉管節(jié)上,且待沉管節(jié)上的應答器在一個平面上,即可根據(jù)三點共面條件,通過求解應答器坐標獲取待沉管節(jié)平面上的3個點,繼而求出待沉管節(jié)平面在基陣坐標系中的姿態(tài)信息。

設待沉管節(jié)平面的平面方程為

Ax+By+Cz=1

(1)

式中A、B、C為未知參數(shù),至少需要3個不共線的坐標,可解出A、B、C。之后,可通過平面的法線式方程得到待沉管節(jié)平面在基陣坐標系中的法向矢量,即待沉管節(jié)平面的方向余弦向量。

(2)

(3)

設USBL基陣所在的平面為XOY,則基陣平面的法向量就可表示為IU=[0,0,1]′,則從管節(jié)平面法向量到USBL基陣平面法向量的旋轉矩陣可表示為

(4)

設從USBL平面到待沉管節(jié)平面的繞基陣坐標軸旋轉的歐拉角為θx、θy、θz,則R是關于θx、θy、θz的旋轉矩陣,根據(jù)旋轉矩陣R即可以求出待沉管節(jié)平面的姿態(tài)角度。

1.3 多址定位技術

由位姿解算方法可知,對沉管定位過程中需要對多個應答器(≥3)進行定位,因此涉及水下多址定位技術,即每個應答器通過發(fā)射不同形式的脈沖信號,超短基線系統(tǒng)根據(jù)接收到的脈沖信號來分辨不同的應答器,并確定每個應答器在基陣坐標系下的坐標。由于自身具有調節(jié)參數(shù)的能力以及對信號和噪聲的先驗知識要求少,且在高信噪比下,Notch濾波器有著良好的相位差估計能力,可以作為超短基線系統(tǒng)多址信號檢測器及相位差估計器。

首先根據(jù)應答器的個數(shù)來設計可用帶寬,Notch的每路參考信號的頻率分別對應應答器的中心頻率。假設需要安裝3個應答器,則其對應的3路并聯(lián)Notch濾波器的結構圖見圖2。

圖2 3路并聯(lián)的Notch濾波器

對每一個應答器,X(t)為基陣接收的信號。

X(t)=Bcos(ω0t-φ)+n(t)

(5)

式中:n(t)為背景噪聲。

ri(t)為兩路正交的參考信號,y(t)為參考信號正交信號的內積,ε(t)為接收信號與參考信號內積的誤差。對參考信號的頻率已知,分別對應單個應答器發(fā)射信號的中心頻率。

rs(i)(t)=Asinωit

rc(i)(t)=Acosωit

(6)

式中:A為參考信號的幅值,下標i代表應答器的身份編號,i=1、2、3。

基陣接收的每一路信號都要通過3路并聯(lián)的Notch濾波器,選擇合適的自適應算法,通過濾波器的輸出結果就可以檢測出發(fā)送該信號所對應的應答器。然后通過相位差估計器解算出該信號在基陣相鄰陣元間的相位差。

(7)

式中:下標i代表應答器的身份;m、n代表基陣中相鄰的陣元。

2 仿真計算

通過仿真計算來驗證USBL對應答器進行定位解算待沉管節(jié)平面位姿的有效性。仿真中,USBL定位系統(tǒng)測時誤差取值為0.1 ms,定位精度誤差取值為0.1%斜距。待沉管節(jié)上安裝有3個不共線的應答器,組成一個直角三角形,管節(jié)平面相對于USBL基陣坐標的歐拉旋轉角度設置為θx=5°,θy=10°,θz=15°。

通過上述位姿解算方法,求解出待沉管節(jié)平面相對于USBL基陣的歐拉角:θx=4.95°,θy=10.04°,其中繞Z軸的歐拉角出現(xiàn)無解狀態(tài),這是由于方向余弦矩陣有9個分量,實際只有3個自由度,假設歐拉角為未知量,通過法向量直接求解方向余弦矩陣,則使得矩陣為非滿秩陣,從而出現(xiàn)繞Z軸歐拉角度無解的狀態(tài)。為此,配合應答器初始位置,并通過已解算出來的θx、θy值,再解算繞Z軸的歐拉角,最終得到管節(jié)平面繞Z軸旋轉的歐拉角。仿真求解的歐拉角均值:θx=5.001 4°,θy=10.038°,θz=15.78°,計算誤差:Δθx=0.01°,Δθy=0.02°,Δθz=0.03°。見圖3。

圖3 管節(jié)平面位姿角度仿真計算結果(基陣坐標系)

2.1 姿態(tài)角估計精度

管節(jié)姿態(tài)角估計精度與超短基線定位精度有直接關系,因此仿真驗算了定位精度和姿態(tài)角估計精度之間的關系。仿真步驟:沉管在大地坐標系下的歐拉角精確值為[5° 10° 15°],改變超短基線定位系統(tǒng)的定位精度,求姿態(tài)角的誤差。以繞X軸姿態(tài)角誤差為例,結果見表1。

表1 USBL定位精度與繞X軸歐拉角的關系

表1中R為基陣坐標系原點到局部坐標系原點的斜距。由表1可見,超短基線定位精度由0.050R增加到0.001R時,回收平臺姿態(tài)角度誤差也就越來越小。在水文環(huán)境較好的背景下,基于Notch濾波器的超短基線定位系統(tǒng)的精度高于0.010R時,此時姿態(tài)角誤差達到了0.010°,可以滿足工程需要。

2.2 沉管表面應答器個數(shù)

理論上3個應答器即可決定沉管的定位面,且應答器個數(shù)越多,冗余信息量增加,參數(shù)估計的精度有相應提高。但應答器個數(shù)太多,會增加成本和計算復雜度。為了研究應答器個數(shù)和姿態(tài)角估計精度之間的關系,進行了如下仿真計算:改變應答器的個數(shù),對每個應答器的位置進行解算。每增加一個應答器,就利用新的冗余信息對前一次計算的歐拉角進行修正,求解管節(jié)平面的姿態(tài)角(以繞X軸歐拉角為例),見圖4。

圖4 管節(jié)平面安裝應答器個數(shù)與姿態(tài)角度(繞X軸)誤差的關系

圖4表明,當應答器個數(shù)從3增至1 000個,姿態(tài)角估計精度也逐漸提高。但精度的提高僅在極小的量級,最高不超過0.020°,不符合工程實際。并且由仿真可知,當定位精度高于0.010R時,安裝3個應答器的角度估計誤差便小于0.010°。

2.3 應答器的布放

除應答器個數(shù),還需考慮應答器布放位置和姿態(tài)角估計精度之間的關系。根據(jù)幾何關系,不共線3點能決定一個平面,因此只需要3個應答器位置不在一條直線上,理論上都是可以解出唯一平面。為了研究應答器布放位置和姿態(tài)角估計精度之間的關系,進行了如下仿真計算。仿真步驟:改變應答器的布放位置,采用三種構成形狀,計算歐拉角估計誤差,見表2。

表2 應答器構成形狀與姿態(tài)角估計的關系 (°)

由表2可見,應答器的布放形式對姿態(tài)估計精度沒有影響。這一結論使得應答器在沉管上的安裝變得更為方便,可以根據(jù)施工要求靈活選取,避開高噪聲區(qū)。同時,可將應答器安裝在USBL定位精度較高的基陣正下方,有助于提高位姿算法的精度。

3 結論

相比于單一的傳統(tǒng)沉管下沉測控方法,本文提出基于USBL定位系統(tǒng)的管節(jié)沉放測控方案,在管節(jié)下沉階段可輔助待沉管節(jié)較為精確地布放到待沉區(qū)域(粗測階段),而后結合高精度相對法完成最終的對接定位過程(精測階段)。該方案的優(yōu)勢如下。

1)滿足遠岸、深水的沉管施工要求。超短基線聲學定位系統(tǒng)不依靠岸基上的輔助設施,擺脫了離岸距離的限制。同時,與傳統(tǒng)定位方法相比,在深水區(qū)依然滿足施工精度。與GPS系統(tǒng)結合后,可以實時顯示沉管在大地坐標中的三維姿態(tài)參數(shù),可有效輔助遠岸、深水環(huán)境下的沉管水下沉放施工。

2)設備成本低,安裝方便,作業(yè)安全性高。超短基線聲學定位系統(tǒng)體積小、成本低廉。作業(yè)前只需要在沉管上表面按需求安裝3個應答器,無需安裝測量塔,安裝過程在水面進行,可減少施工人員下水作業(yè)次數(shù)。整個施工過程效率高、安全性高、操作復雜性低。

猜你喜歡
應答器位姿基線
高度角對GNSS多系統(tǒng)組合短基線RTK影響
基于Kriging算法的虛擬應答器捕獲方法
巧用應答器,提高小學語文課堂實效
GNSS 靜態(tài)相對定位精度分析與比較
基于最小二乘法的超短基線水聲定位系統(tǒng)校準方法
基于PLC的六自由度焊接機器人手臂設計與應用
基于位置依賴的密集融合的6D位姿估計方法
基于英標聯(lián)鎖的ETCS1級系統(tǒng)應答器設置簡析
基于英標聯(lián)鎖的ETCS1級系統(tǒng)應答器設置簡析
曲柄搖桿機構的動力學仿真