基于水下激光雷達傳感的液壓飛頭對接系統(tǒng)與控制技術(shù)研究

程友祥，葉天源，譚西都，劉晨曦，宋琦

（重慶前衛(wèi)海洋石油工程設(shè)備有限責(zé)任公司，重慶 401121）

基于水下激光雷達傳感的液壓飛頭對接系統(tǒng)與控制技術(shù)研究

程友祥，葉天源，譚西都，劉晨曦，宋琦

（重慶前衛(wèi)海洋石油工程設(shè)備有限責(zé)任公司，重慶 401121）

液壓飛頭水下對接質(zhì)量很大程度上受水下機器人（ROV）定位導(dǎo)航精度的制約。針對對接過程中聲學(xué)傳感器的作用距離無法覆蓋、圖像傳感器無法適應(yīng)惡劣水質(zhì)環(huán)境的問題，提出了基于水下激光雷達與ROV位姿傳感器的液壓飛頭對接系統(tǒng)以及相應(yīng)的多傳感器信息融合算法和ROV定位導(dǎo)航控制方法，改善ROV操作水下多功能快速接頭的精度，實現(xiàn)其快速準確對接，并通過實驗驗證，為ROV在深海環(huán)境作業(yè)節(jié)約寶貴時間。

液壓飛頭；水下激光雷達；ROV

液壓飛頭又稱水下多功能液壓快速接頭（Multi Hydraulic Quick Connector），簡稱為 MQC，是用來在水下同時連接多個單路液壓接頭的裝置，可以同時連接或斷開多條液壓管路，多用于海洋石油工程的水下油氣生產(chǎn)系統(tǒng)中高壓注醇、注化學(xué)藥品、注水和注氣，以及液壓控制，是水下生產(chǎn)系統(tǒng)的核心裝備之一。利用水下生產(chǎn)系統(tǒng)進行深水油氣田的開發(fā)，可有效解決深水開發(fā)中的很多技術(shù)難點，如水深對平臺和設(shè)備的影響較小、能適應(yīng)不同型式的立管、成本相對干式采油樹較低等。

由ROV完成其連接和斷開的操作，在對接之前，ROV需要到達一個合適對接操作的位置，但由于傳統(tǒng)的聲學(xué)和攝像傳感器定位精度受限，需要花費大量的時間進行多次嘗試，因此， ROV到達最合適作業(yè)位置并用機械手鎖緊把手固定其位置是最關(guān)鍵技術(shù)之一。盡管目前國內(nèi)在基于ROV水聲定位系統(tǒng)的多功能液壓快速接頭對接研究已取得一定的成果，但水聲定位系統(tǒng)進行定位存在兩個問題，一是聲學(xué)傳感器的測量精度較低；二是數(shù)據(jù)刷新頻率受限于聲波在水中的傳播速度。所以本文對環(huán)境未知情況下ROV的自身定位技術(shù)進行了研究，提出了一種基于水下激光雷達傳感原理的新型組合定位方法。

1 MQC的結(jié)構(gòu)與工作原理

水下多路液壓快速接頭是用來接通多個水下管路的裝置，可用以接通或斷開多路液壓管路。根據(jù)需要，上面一般可安裝4～32個各種不同的水下接頭，MQC需要對接頭的正確連接提供軸向和旋轉(zhuǎn)方向的導(dǎo)向，并提供一個足夠大的鎖緊力以抵抗在連接過程中由于管道中的液體壓力產(chǎn)生的分離力，這就需要MQC具有一套可靠的鎖緊機構(gòu)，能夠?qū)啥说慕宇^安裝板可靠的鎖緊在一起，從而確保接頭可靠的密封和導(dǎo)通。一套完整的MQC裝置由以下幾個部分組成，如圖1所示。

圖1 MQC裝置組成部分

MQC裝置其對接過程可分為以下幾步。第一步，取下移動端的防塵帽，防塵帽是用來在下水前保護移動端的，防止外界對移動端的污染和破壞，其結(jié)構(gòu)較簡單。第二步，取下固定端和暫置位保護帽，當(dāng)沒有移動端安裝時，保護帽是用來保護長時間安裝在海底的固定端和暫置位，以防止海底的沙泥對固定端和暫置位的污染，還可以阻止海里的碳酸鈣在公接頭上凝結(jié)。第三步，ROV通過機械手操作移動端插入到固定端口，使用扭矩工具完成對接，以實現(xiàn)管路的連通。移動端上安裝有相應(yīng)的多個母接頭，軸向或圓周方向上的定位銷或鍵，以及相應(yīng)的鎖緊機構(gòu)；固定端固定安裝在水下設(shè)備（如采油樹）上，安裝有多個公接頭，軸向和圓周方向上的導(dǎo)向套或?qū)虿?，以及相?yīng)的鎖緊機構(gòu)。第四步：完成連通需求后，移動端從固定端上拔出，在沒有收回到海上時，需要將移動端暫時的放置在暫置位上，用來給移動端提供陰極保護，暫置位的結(jié)構(gòu)和尺寸和固定端是一樣的，唯一的區(qū)別是其上安裝的不是真正的公接頭，而是一種仿真的公接頭，這種接頭不起導(dǎo)通作用。

2 基于水下激光雷達與ROV位姿傳感器對接系統(tǒng)

MQC對接系統(tǒng)由ROV本體、水下激光傳感器、羅盤、IMU、攝像系統(tǒng)與聲吶系統(tǒng)等組成，如圖2所示。

圖2 對接系統(tǒng)ROV構(gòu)成

ROV遠距離探測目標方位時，依然通過傳統(tǒng)的聲吶定位系統(tǒng)完成，當(dāng)ROV機械臂通過扭矩工具使MQC對接的過程中，是依靠攝像系統(tǒng)生成的圖像信息來操作完成，然而在中距離定位到MQC對接的中間距離（在2～4m）時，限于聲學(xué)系統(tǒng)與圖像系統(tǒng)在該區(qū)段的分辨精度低，而水下激光雷達可在該區(qū)段保持較高的定位精度，提出基于水下激光雷達的對接系統(tǒng)來提高該區(qū)段對接快速準確性，其工作性能的顯著提高主要體現(xiàn)在機械手臂在對接之前抓取并鎖緊固定把手位置的準確性上。傳統(tǒng)的依靠聲吶與攝像對接方式在抓緊并鎖住ROV到合適的操作對接位置需要嘗試平均4～6次，而基于水下激光雷達的對接方式大大縮短了機械手抓取次數(shù)（圖3）。

圖3 ROV機械臂抓住并鎖緊固定端

水下激光傳感器是基于飛時傳感法 (Time of Flight)簡稱TOF。其工作原理是從激光頭發(fā)出激光射線，等待接收從物體上反射的激光信號，利用發(fā)送和接收的激光飛行時間來計算測量距離，原理如圖4所示。由于其獨特的測量原理，激光傳感器具有高速、精準等特點。與聲納相比，ROV配備水下激光傳感不存在散射問題，激光受入射角的影響也非常小，在一般的物體表面上，即使入射角接近90°時激光仍能夠按入射方向返回,因此可以得到十分精確的數(shù)據(jù)。而這正好滿足了ROV對于環(huán)境感知傳感器在實時性和準確性方面的要求。但是激光傳感器的測量數(shù)據(jù)受到自身溫度變化導(dǎo)致的漂移與激光雷達相近頻率成分的光源干擾、混合像素干擾、放射性障礙物表面導(dǎo)致的測量誤差、障礙物遮擋造成的掃描盲區(qū)等。

圖4 飛時傳感法的測量原理

為克服激光傳感器在某些特定環(huán)境下所測數(shù)據(jù)存在的不足，將水下激光雷達與ROV位姿傳感器組合使用，因此，ROV除配備有水下激光雷達外，還使用HMR3000型三軸磁羅盤，其由Honeywell公司生產(chǎn)，可測量ROV的艏向角、縱傾角和橫傾角。數(shù)據(jù)更新頻率為十幾赫茲，測量精度為0．1度。由于磁羅盤容易受鐵磁性物體和電機電磁場的干擾，因此將羅盤壓力筒安裝在的前上部，將外部干擾的影響降到最低。使用IMU5200捷聯(lián)慣導(dǎo)系統(tǒng)，測量ROV的三軸姿態(tài)角(或角速率)以及加速度。該IMU包含了三個單軸的加速度計和三個單軸的陀螺儀，加速度計檢測ROV在載體坐標系統(tǒng)獨立三軸的加速度信號，而陀螺儀檢測載體相對于導(dǎo)航坐標系的角速度信號，測量ROV在三維空間中的角速度和加速度，并以此解算出其空間姿態(tài)。IMU安裝在電子艙的壓力筒內(nèi)，使用RS232串口進行數(shù)據(jù)通訊，數(shù)據(jù)更新頻率為100Hz。利用以上三種傳感器性能的互補性，通過信息融合技術(shù)，可以很大程度改善ROV的定位精度。ROV在水下作業(yè)狀況下，水下激光雷達傳感器固定在ROV機械手臂前側(cè)，PC控制器下發(fā)指令使水下激光雷達發(fā)射器不斷發(fā)射水下激光雷達脈沖，激光脈沖由發(fā)射光學(xué)系統(tǒng)射出時，時鐘計數(shù)器得到起始信號開始計數(shù)，激光射到被測目標上（如采油樹）發(fā)生反射，然后由光學(xué)系統(tǒng)接收后對計數(shù)器發(fā)出終止信號，最終提取時鐘計數(shù)器計數(shù)值，PC控制器提取相關(guān)數(shù)據(jù)信息，計算得出被測目標（如采油樹）的方位距離，處理HMR3000型三軸磁羅盤與IMU5200捷聯(lián)慣導(dǎo)系統(tǒng)不斷上傳ROV的位姿信息，實時判斷MQC與對接目標的距離與方位。

3 ROV定位導(dǎo)航控制系統(tǒng)

本文研究的ROV定位導(dǎo)航控制系統(tǒng)分為外部傳感器系統(tǒng)、上位機系統(tǒng)以及運動控制系統(tǒng)三部分，如圖5所示。水下激光雷達傳感器發(fā)射激光脈沖信號，經(jīng)采油樹反射后，接收光學(xué)系統(tǒng)接收水下激光雷達反射信號，并經(jīng)過信號處理器濾波，把從光電轉(zhuǎn)換器輸出的微弱電信號放大成具有一定幅度、信噪比和脈沖寬度的電信號上傳至ROV上位機。

上位機控制系統(tǒng)融合各傳感器返回ROV的位姿信息，進行時間對準、空間對準、數(shù)據(jù)關(guān)聯(lián)、特征級數(shù)據(jù)融合，認知環(huán)境，提取對接目標信息，基于子系統(tǒng)精確模型的最優(yōu)路徑控制，建立混合智能算法求解模型，最終實現(xiàn)具有一定魯棒性以及對外部擾動有一定適應(yīng)性的ROV動態(tài)路徑規(guī)劃控制方法。采用先導(dǎo)預(yù)測的控制策略，實現(xiàn)機器人系統(tǒng)的自適應(yīng)地圖誤差修正和自學(xué)習(xí)功能，以及自主導(dǎo)控任務(wù)的全局優(yōu)化, 并對未知動態(tài)環(huán)境具有較強的適應(yīng)性。對此，ROV能夠?qū)崿F(xiàn)自主定位導(dǎo)航與路徑規(guī)劃，最終上位機控制系統(tǒng)將控制指令下發(fā)至運動控制系統(tǒng)，推進系統(tǒng)由4臺45°矢量布局的加速導(dǎo)管型螺旋槳組成，方便動力定位定艏控制。ROV相對水平方向與垂直方向的偏移由被測目標的方位確定，ROV位姿的變化量由水平方向的4個推進器與垂直方向的一個推進器輸出推力的大小控制，運動控制單元對推進器進行動力分配，實現(xiàn)ROV位姿的調(diào)整，同時運動控制單元將下發(fā)的推力指令反饋到ROV上位機里，上位機經(jīng)過預(yù)知判斷下步指令。當(dāng)ROV與采油樹相距合適距離時，ROV一只機械手鎖住采油樹固定設(shè)備處，使ROV整體小范圍浮動在對接入口，另一只機械手將固定端的保護帽取下放置到暫置位上，然后抓住移動端的提升手柄將其平穩(wěn)準確地插入固定端接口處。

在以上過程中，移動端與固定端的成功對接并不都是一次就能完成，執(zhí)行機構(gòu)的實時位姿狀態(tài)與固定端的對接口相對位置信息通過反饋裝置反饋給運動控制集成單元，與此同時，ROV本體以及抓取機械手需要根據(jù)控制單元的運動控制指令不斷微調(diào)自己的位姿，而快速準確的運動指令必須依賴激光傳感器對固定端的準確位置信息進行提取識別，最后由上位機進行信息融合處理。

4 實驗驗證分析

為了驗證上面的基于水下激光雷達與ROV位姿傳感器的液壓飛頭對接系統(tǒng)以及相應(yīng)多傳感器信息融合算法和ROV定位導(dǎo)航控制方法相比于傳統(tǒng)液壓飛頭對接方法的優(yōu)越性能，在深水池進行相關(guān)模擬對接實驗，如圖6所示。大量實驗結(jié)果表明，當(dāng)ROV只配備有聲納，HMR3000型三軸磁羅盤、IMU5200捷聯(lián)慣導(dǎo)系統(tǒng)以及攝像系統(tǒng)時，ROV在液壓飛頭成功對接之前需要進行4至6次換位，所需時間平均在400s左右，在以上基礎(chǔ)上，新增水下激光雷達設(shè)備后，ROV只需進行1至2次換位，對接時間縮短至220s左右，對接效率提高了45%，這對于水下作業(yè)的ROV不僅節(jié)約了寶貴的時間，還大大減少了人力物力資源的消耗。

圖6 深水池對接試驗

5 結(jié)語

為了實現(xiàn)水下機器人ROV自主導(dǎo)航能力，提高MQC對接速度和精度，與常規(guī)ROV單單基于聲納導(dǎo)航定位不同，水下激光雷達由于能量集中不存在散射的問題，而且具備光速遠超聲速且探傳感離較遠的諸多優(yōu)點，所以結(jié)合水下激光雷達傳感原理，提出了中距離基于水下激光雷達與ROV位姿傳感器的液壓飛頭對接系統(tǒng)以及相應(yīng)的多傳感器信息融合算法和ROV定位導(dǎo)航控制方法，并作出較為詳細的理論闡述。該控制系統(tǒng)的各個子控制系統(tǒng)之間形成有效的信息反饋網(wǎng)絡(luò)，使得位置信息能夠快速識別，準確提取以及運動指令信息的準確整合，這樣為MQC的成功對接節(jié)約了寶貴時間。

圖5 控制系統(tǒng)組成圖

[1]劉立新,侯莉,王鳳云．水下多功能液壓快速接頭的研究概述[J]．機械工程師,2015,(05):143-146．

[2]楊放瓊．基于信息融合的移動機器人定位導(dǎo)航及其深海采礦應(yīng)用研究[D]．中南大學(xué),2010．

[3]邱權(quán)．移動機器人激光傳感器性能綜述[A]．中國儀器儀表學(xué)會,2008:6．

[4]張麗,李名莉．溫室機器人道路識別與路徑導(dǎo)航研究——基于紅外傳感[J]．農(nóng)機化研究,2017,(04):221-225．

[5]蔣曉玲．基于激光雷達傳感技術(shù)的汽車防撞保護器設(shè)計[D]．湖南大學(xué),2011．

[6]朱康武．作業(yè)型ROV多變量位姿魯棒控制方法研究[D]．浙江大學(xué),2012．

TN958.98

A

1671-0711（2017）08（下）-0149-03