水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)及成像方法
【專利摘要】本發(fā)明涉及一種水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)及成像方法，包括水下機(jī)器人、水面光端機(jī)、水面上位機(jī)，水下機(jī)器人上設(shè)有4個(gè)水平分量測(cè)距聲納和1個(gè)垂直分量測(cè)距聲納，其中4個(gè)水平分量測(cè)距聲納的相互之間方位差為90度；水下機(jī)器人上還設(shè)有光纖陀螺儀。通過4個(gè)水平分量測(cè)距聲納可獲得斜井的一幀二維圖像序列，水面上位機(jī)對(duì)一系列二維圖像序列進(jìn)行數(shù)據(jù)處理，通過對(duì)斜井的幾何尺寸和4個(gè)水平分量測(cè)距聲納數(shù)據(jù)進(jìn)行處理，使二維圖像序列垂直軸向上對(duì)齊，通過光纖陀螺儀測(cè)得的艏向角度使二維圖像序列水平方向?qū)R，再結(jié)合垂直分量測(cè)距聲納測(cè)得的機(jī)器人到水面垂直距離，實(shí)時(shí)繪制出斜井的二維和三維圖像。
【專利說(shuō)明】水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)及成像方法【技術(shù)領(lǐng)域】
[0001]本發(fā)明涉及一種水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)及成像方法。
【背景技術(shù)】
[0002]近年來(lái)，聲納成像在水聲領(lǐng)域受到廣泛關(guān)注和發(fā)展，利用三維成像聲納在水質(zhì)渾濁和光照條件較差的條件下仍可獲取水下目標(biāo)的外形輪廓的細(xì)節(jié)信息和環(huán)境信息。三維成像聲納是一種高分辨率的圖像聲納，能夠提供非常優(yōu)秀的圖像質(zhì)量。它以波束形成或聲透鏡技術(shù)為基礎(chǔ)，目前主要有兩種技術(shù)路線:一是采用一維線陣，通過機(jī)械平移合成二維面陣；第二種是直接采用二維面陣，在水平、垂直、距離3個(gè)方向上直接獲得分辨率。把圖像聲納裝載到各種水下智能機(jī)器人(Automatic Underwater Vehicle, AUV)、遙控水下機(jī)器人(ROV)和水下無(wú)人潛器(UUV)上進(jìn)行水下作業(yè)，可對(duì)水下堤壩、管道、橋墩和海港等進(jìn)行探測(cè)。借助計(jì)算機(jī)可視化技術(shù)，將探測(cè)結(jié)果以生動(dòng)的三維圖形圖像的方式表現(xiàn)出來(lái)，通過縮放、移動(dòng)、轉(zhuǎn)動(dòng)和測(cè)距等操作從各種視角進(jìn)行觀察和分析，提高水下探測(cè)的效率。
[0003]水利蓄能電站斜井內(nèi)管壁探測(cè)對(duì)研制新型成像聲納和三維成像方法提出了需求，因?yàn)閷?duì)水利蓄能電站斜井探測(cè)來(lái)說(shuō)，一方面目前的圖形聲納是一維或二維的傳感器陣，需要非常多的水聲傳感器單元，對(duì)安裝精度的要求很高，硬件制作成本和軟件計(jì)算成本也都很高；另一方面，因?yàn)樾本旧硎莻€(gè)圓柱形，水平截面是個(gè)橢圓形，傳統(tǒng)的三維成像聲納很難獲得水平全向的斜井三維圖像，必須采用技術(shù)手段進(jìn)行拼接，實(shí)現(xiàn)起來(lái)較為困難，且實(shí)際效果很難保證。另外，水下機(jī)器 人依靠螺旋槳推進(jìn)器控制其在水中運(yùn)動(dòng)，由于其非線性水動(dòng)力學(xué)特性、水流的隨機(jī)干擾和差分反饋控制機(jī)制等因素的影響，在下潛和水平旋轉(zhuǎn)過程中很難使它保持一致的相對(duì)位置。與機(jī)器人剛性連接的聲納系統(tǒng)受此影響，采集的二維目標(biāo)圖像切片不能在垂直軸向和水平方向?qū)R，導(dǎo)致三維繪制扭曲失真。

【發(fā)明內(nèi)容】

[0004]本發(fā)明目的在于提供一種水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)及成像方法，能夠?qū)崿F(xiàn)全面探測(cè)，并且能夠有效避免探測(cè)圖像失真。
[0005]基于同一發(fā)明構(gòu)思，本發(fā)明具有兩個(gè)獨(dú)立的技術(shù)方案:
[0006]1.一種水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，包括水下機(jī)器人、水面光端機(jī)、水面上位機(jī)，水下機(jī)器人與水面光端機(jī)通信連接，水面光端機(jī)與水面上位機(jī)通信連接，其特征在于:水下機(jī)器人上設(shè)有4個(gè)水平分量測(cè)距聲納和I個(gè)垂直分量測(cè)距聲納，其中4個(gè)水平分量測(cè)距聲納的相互之間方位差為90度；水下機(jī)器人上還設(shè)有光纖陀螺儀。
[0007]水下機(jī)器人上還設(shè)有深度計(jì)。
[0008]水下機(jī)器人上設(shè)有串口服務(wù)器，串口服務(wù)器可以是以太網(wǎng)交換機(jī)，用于上傳水下機(jī)器人運(yùn)動(dòng)狀態(tài)、光纖陀螺儀、深度計(jì)和五分量測(cè)距聲納的數(shù)據(jù)。
[0009]水面光端機(jī)可以為快速光纖以太網(wǎng)卡，實(shí)現(xiàn)水面上位機(jī)和水下機(jī)器人通信連接。
[0010]水面上位機(jī)可以是工業(yè)筆記本或臺(tái)式電腦，負(fù)責(zé)向下發(fā)送命令，接收水下機(jī)器人的數(shù)據(jù)并進(jìn)行處理，實(shí)時(shí)繪制二維和三維斜井圖像。
[0011]光纖陀螺儀可以是數(shù)字光纖陀螺，可測(cè)量相對(duì)機(jī)器人初始艏向的相對(duì)角度和積分角度。
[0012]2.一種利用上述水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)的成像方法，其特征在于:水下機(jī)器人的運(yùn)動(dòng)步驟為，
[0013]步驟1:初始化機(jī)器人位置和校正艏向零度；
[0014]步驟2:機(jī)器人保持艏向下潛動(dòng)作，下潛一步長(zhǎng)； [0015]步驟3:機(jī)器人原地逆時(shí)針旋轉(zhuǎn)90度進(jìn)行掃描動(dòng)作，利用測(cè)距聲納掃描測(cè)距；
[0016]步驟4:機(jī)器人保持艏向下潛動(dòng)作，再下潛一步長(zhǎng)；
[0017]步驟5:機(jī)器人原地順時(shí)針旋轉(zhuǎn)90度進(jìn)行掃描動(dòng)作，利用測(cè)距聲納掃描測(cè)距；
[0018]步驟6:重復(fù)步驟2—步驟5，直至機(jī)器人下潛結(jié)束；
[0019]上述步驟3和步驟5中，通過4個(gè)水平分量測(cè)距聲納可獲得斜井的一幀二維圖像序列，水面上位機(jī)對(duì)一系列二維圖像序列進(jìn)行數(shù)據(jù)處理，通過對(duì)斜井的幾何尺寸和4個(gè)水平分量測(cè)距聲納數(shù)據(jù)進(jìn)行處理，使二維圖像序列垂直軸向上對(duì)齊，通過光纖陀螺儀測(cè)得的艏向角度使二維圖像序列水平方向?qū)R，再結(jié)合垂直分量測(cè)距聲納測(cè)得的機(jī)器人到水面垂直距離，實(shí)時(shí)繪制出斜井的二維和三維圖像。
[0020]通過對(duì)斜井的幾何尺寸和4個(gè)水平分量測(cè)距聲納數(shù)據(jù)進(jìn)行處理，使二維圖像序列垂直軸向上對(duì)齊，具體通過如下方法實(shí)現(xiàn):
[0021]通過4個(gè)水平分量測(cè)距聲納，同一時(shí)刻可獲得水下機(jī)器人前后左右4個(gè)目標(biāo)距離信息，分別用a, c, b, d表示,對(duì)應(yīng)的斜井內(nèi)壁的四個(gè)頂點(diǎn)AU1, Y1)、B(x2, y2)、C(x3, y3)、D(x4, y4)，0(xq，y0)為斜井水平橢圓截面中心,X1, Y1^x2, y2、x3, y3、x4, y4, x0, y0為相應(yīng)的坐標(biāo)。
[0022]根據(jù)4個(gè)水平分量測(cè)距聲納的距離信息和斜井的幾何尺寸，計(jì)算斜井水平橢圓截面相對(duì)機(jī)器人位置的坐標(biāo)，計(jì)算公式如下:
[0023]
【權(quán)利要求】
1.一種水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，包括水下機(jī)器人、水面光端機(jī)、水面上位機(jī)，水下機(jī)器人與水面光端機(jī)通信連接，水面光端機(jī)與水面上位機(jī)通信連接，其特征在于:水下機(jī)器人上設(shè)有4個(gè)水平分量測(cè)距聲納和I個(gè)垂直分量測(cè)距聲納，其中4個(gè)水平分量測(cè)距聲納相互之間方位差為90度；水下機(jī)器人上還設(shè)有光纖陀螺儀。
2.根據(jù)權(quán)利要求1所述的水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，其特征在于:水下機(jī)器人上還設(shè)有深度計(jì)。
3.根據(jù)權(quán)利要求2所述的水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，其特征在于:水下機(jī)器人上設(shè)有串口服務(wù)器，串口服務(wù)器可以是以太網(wǎng)交換機(jī)，用于上傳水下機(jī)器人運(yùn)動(dòng)狀態(tài)、光纖陀螺儀、深度計(jì)和五分量測(cè)距聲納的數(shù)據(jù)。
4.根據(jù)權(quán)利要求3所述的水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，其特征在于:水面光端機(jī)可以為快速光纖以太網(wǎng)卡，實(shí)現(xiàn)水面上位機(jī)和水下機(jī)器人通信連接。
5.根據(jù)權(quán)利要求4所述的水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，其特征在于:水面上位機(jī)可以是工業(yè)筆記本或臺(tái)式電腦，負(fù)責(zé)向下發(fā)送命令，接收水下機(jī)器人的數(shù)據(jù)并進(jìn)行處理，實(shí)時(shí)繪制二維和三維斜井圖像。
6.根據(jù)權(quán)利要求5所述的水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)，其特征在于:光纖陀螺儀可以是數(shù)字光纖陀螺，可測(cè)量相對(duì)機(jī)器人初始艏向的相對(duì)角度和積分角度。
7.一種利用權(quán)利要求1所述水下機(jī)器人五分量測(cè)距聲納斜井三維成像系統(tǒng)的成像方法，其特征在于:水下機(jī)器人的運(yùn)動(dòng)步驟為: 步驟1:初始化機(jī)器人位置和校正艏向零度； 步驟2:機(jī)器人保持艏向下潛動(dòng)作，下潛一步長(zhǎng)； 步驟3:機(jī)器人原地逆時(shí)針旋轉(zhuǎn)90度進(jìn)行掃描動(dòng)作，利用測(cè)距聲納掃描測(cè)距； 步驟4:機(jī)器人保持艏向下潛動(dòng)作，再下潛一步長(zhǎng)； 步驟5:機(jī)器人原地順時(shí)針旋轉(zhuǎn)90度進(jìn)行掃描動(dòng)作，利用測(cè)距聲納掃描測(cè)距； 步驟6:重復(fù)步驟2—步驟5，直至機(jī)器人下潛結(jié)束； 上述步驟3和步驟5中，通過4個(gè)水平分量測(cè)距聲納均可獲得斜井的一幀二維圖像序列，水面上位機(jī)對(duì)一系列二維圖像序列進(jìn)行數(shù)據(jù)處理，通過對(duì)斜井的幾何尺寸和4個(gè)水平分量測(cè)距聲納數(shù)據(jù)進(jìn)行處理，使二維圖像序列垂直軸向上對(duì)齊，通過光纖陀螺儀測(cè)得的艏向角度使二維圖像序列水平方向?qū)R，再結(jié)合垂直分量測(cè)距聲納測(cè)得的機(jī)器人到水面垂直距離，實(shí)時(shí)繪制出斜井的二維和三維圖像。
8.根據(jù)權(quán)利要求7所述的方法，其特征在于:通過對(duì)斜井的幾何尺寸和4個(gè)水平分量測(cè)距聲納數(shù)據(jù)進(jìn)行處理，使二維圖像序列垂直軸向上對(duì)齊，具體通過如下方法實(shí)現(xiàn): 通過4個(gè)水平分量測(cè)距聲納，同一時(shí)刻可獲得水下機(jī)器人前后左右4個(gè)目標(biāo)距離信息，分別用a, c, b, d表示,對(duì)應(yīng)的斜井內(nèi)壁的四`個(gè)頂點(diǎn)AU1, Y1)、B(x2, y2)、C(x3, y3)、D(x4, y4),o(x0, y0)為斜井水平橢圓截面中心，X1, Υι> χ2,12、χ3.y3> χ4.y4? χ0.y0為相應(yīng)的坐標(biāo)， 根據(jù)4個(gè)水平分量測(cè)距聲納的距離信息和斜井的幾何尺寸，計(jì)算斜井水平橢圓截面相對(duì)機(jī)器人位置的坐標(biāo)，計(jì)算公式如下:
9.根據(jù)權(quán)利要求8所述的方法，其特征在于:通過光纖陀螺儀測(cè)得的艏向角度使二維圖像序列水平方向?qū)R，具體通過如下方法實(shí)現(xiàn): 針對(duì)光纖陀螺測(cè)得的艏向角，通過向下取整或者曲線擬合的方法獲得整數(shù)角度值，相同艏向值上下對(duì)正，實(shí)現(xiàn)二維圖像序列水平角度的對(duì)齊。
10.根據(jù)權(quán)利要求9所述的方法，其特征在于:機(jī)器人下潛的一步長(zhǎng)為一米。
【文檔編號(hào)】G01S15/89GK103744085SQ201410022662
【公開日】2014年4月23日 申請(qǐng)日期:2014年1月17日 優(yōu)先權(quán)日:2014年1月17日
【發(fā)明者】聶東虎, 喬鋼, 桑恩方, 周鋒, 馬雪飛, 孫宗鑫, 劉淞佐, 章佳榮, 尹艷玲, 楊健敏 申請(qǐng)人:哈爾濱工程大學(xué)