CN110133667B - 基于移动前视声呐的水下三维检测系统 - Google Patents
基于移动前视声呐的水下三维检测系统 Download PDFInfo
- Publication number
- CN110133667B CN110133667B CN201910402909.2A CN201910402909A CN110133667B CN 110133667 B CN110133667 B CN 110133667B CN 201910402909 A CN201910402909 A CN 201910402909A CN 110133667 B CN110133667 B CN 110133667B
- Authority
- CN
- China
- Prior art keywords
- dimensional
- sonar
- underwater
- underwater robot
- information
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/89—Sonar systems specially adapted for specific applications for mapping or imaging
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种基于移动前视声呐的水下三维检测系统。它包括:一个水下机器人、一个捷联惯导系统、一个三维云台、一个姿态传感器、一个前视声呐、一个上位机,捷联惯导系统安装于水下机器人上,内含有速度陀螺,加速度计和微型计算机,姿态传感器安装于三维云台的内部,内含有陀螺仪和加速度计等运动传感器,前视声呐安装于三维云台上,三维云台安装固定于水下机器人下方,三维云台根据姿态传感器信息和捷联惯导系统自动调节前视声呐探测角度,水下机器人与上位机相连,上位机用于远程控制水下机器人和接收声呐数据,上位机可用于显示前视声呐扫描的二维声呐图像数据,提供声呐回波距离以及声呐图像测距功能,用于对水下机器人搭载的前视声呐采集图像信息提取,进而获得声阴影和回波距离信息,通过二维声呐图像声阴影算法计算被检测物体高度信息,实现对水下被检测物体的三维信息的提取,为水下机器人实现水下三维检测提供可靠依据。
Description
技术领域
本发明涉水下机器人的水下三维检测领域,特别是涉及一种用于基于前视声呐二维声呐图像的水下机器人的三维信息检测系统。
背景技术
水下机器人在水下的地形地貌成像,水下目标识别以及水下测绘等方面取得巨大的实际应用成果,水下机器人开始被应用于水下目标三维检测工作。在水下目标三维检测作业过程中,需要根据扫描的二维声呐图像获得被检测物体的三维信息,尤其是高度信息,以保证获取被检测物体的三维信息精确性。
目前基于声阴影信息获取被检测物体的三维信息一般基于已知声呐和河床距离,回波距离及声阴影长度确定,要求水下机器人实时获取声呐与河床距离,但是水下机器人在作业过程中不一定准确获取与河床距离,并且随着河床地形波动,基于声阴影提取被检测物体高度信息存在一定的定位误差,这样就无法获得水下被检测物体的精确三维信息。
中国发明专利ZL 201410031823.0公开了“一种水下探测装置的控制系统”,该水下机器人可以获得水下状况实现探测,采用水下摄像头近距离观测获得水下构筑物的表面信息,不适于浑浊或零可见度水域作业。
中国发明专利ZL 201810541022.7公开了“一种水下探测器控制系统”,通过照明模块获得水下数据,不适于水下三维信息的提取。
中国发明专利ZL 201811246973.6公开了“一种两栖智能水下摄像云台系统”,通过多种环境信号,利用图像处理系统对视频影像处理,不适于浑浊或零可见度水域作业。
中国发明专利ZL 20181046617.4公开了“一种侧扫声呐数据融合于精密处理的海底线检测方法”,通过LOG函数滤波图像作为Canny检测算法的输入图像,不适于声呐二维图像的处理。
中国发明专利ZL 201811246973.6公开了“一种深海救援系统”,通过三维声学成像系统采集声学图像,不适于二维声学图像的三维信息提取。
发明内容
本发明的目的在于要解决现有技术存在的问题,提供一种基于移动前视声呐的水下三维检测系统,实现对水下物体三维信息的检测。
为解决上述技术问题,本发明的构思是:由于声呐图像中被检测物体对于前视声呐发射声波的阻碍,在声呐二维图像中被检测物体后产生声阴影信息,本系统采用安装于水下机器人内部的三维云台与水平面成既定检测角度的前视声呐获取水下二维声呐图像,通过上位机中获取前视声呐到被检测物体的回波距离和被检测物体的切面长度,通过声阴影信息进行三角计算,水下被检测物体的三维高度信息的精确计算。
根据上述发明构思,本发明采用下述技术方案:
一种基于移动前视声呐的水下三维检测系统,它包括:一个水下机器人、一个捷联惯导系统、一个三维云台、一个姿态传感器、一个前视声呐、一个上位机,其所述捷联惯导系统搭载于所述水下机器人上,内含有速度陀螺,加速度计和微型计算机,用于测量所述水下机器人的角运动和线运动信息;所述三维云台安装于所述水下机器人下,用于装载所述前视声呐,通过所述捷联惯导系统和所述姿态传感器综合信息,控制所述三维云台位姿,以实现对所述前视声呐探测角度的自动调节,用于所述水下机器人在水下涌流中调节姿态以保持所述前视声呐既定探测角度;所述姿态传感器安装于所述三维云台的内部,内含有陀螺仪和加速度计等运动传感器,用于获取所述水下机器人的姿态信息;所述前视声呐安装于所述三维云台上,可以进行既定的扫描角度和扫描范围,通过发射声脉冲并接受不同位置回波信号完成水下信息采集,通过二维声呐图像声阴影算法计算被检测物体高度信息,所述上位机可用于显示所述前视声呐扫描的二维声呐图像数据,提供声呐回波距离以及声呐图像测距功能,用于对所述水下机器人搭载的所述前视声呐采集图像信息提取,进而获得声阴影和回波距离信息,实现对水下被检测物体的三维信息的提取,为所述水下机器人实现水下三维检测提供可靠依据。
本发明与现有技术相比较,具有如下显而易见的突出实质性特点和显著进步:本发明采用安装于水下机器人内部的三维云台与水平面成既定检测角度的前视声呐获取水下二维声呐图像,通过上位机中获取前视声呐到被检测物体的回波距离和被检测物体的切面长度,通过声阴影信息进行三角计算,实现水下被检测物体的三维高度信息的精确计算。
本发明的水下三维检测系统可广泛适用于水下机器人的水下目标三维信息检测。
附图说明
图1是本发明一个实施例的结构框图。
图2是本发明的水下机器人水下三维检测系统的高度信息三角计算图。
具体实施方式
本发明的优选实施例结合附图详述如下:
实施例一:
参见图1,在本移动前视声呐的水下三维检测系统中, 包括:一个水下机器人(1)、一个捷联惯导系统(2)、一个三维云台(3)、一个姿态传感器(4)、一个前视声呐(5)、一个上位机(6),其特征在于:
所述水下机器人(1)具有多轴螺旋桨驱动,可实现自身姿态和运动控制,通过以太网与所述上位机(6)相连;
所述捷联惯导系统(2)搭载于所述水下机器人(1)上,内含有速度陀螺,加速度计和微型计算机,用于测量所述水下机器人(1)的角运动和线运动信息;
所述三维云台(3)安装于所述水下机器人下,用于装载所述前视声呐(5),通过所述捷联惯导系统(2)和所述姿态传感器(4)综合信息,控制所述三维云台(3)位姿,以实现对所述前视声呐(5)探测角度的自动调节,用于所述水下机器人(1)在水下涌流中调节姿态以保持所述前视声呐(5)既定探测角度;
所述姿态传感器(4)安装于所述三维云台(3)的内部,内含有陀螺仪和加速度计等运动传感器,用于获取所述水下机器人(1)的姿态信息;
所述前视声呐(5)安装于所述三维云台(4)上,可进行既定的扫描角度和扫描范围,通过发射声脉冲并接受不同位置回波信号完成水下信息采集;
实施例二:
本实施例与实施例一基本相同,特别之处在于:
本基于移动前视声呐的水下三维检测系统,所述上位机(6)用于远程控制所述水下机器人(1)和接收声呐数据,显示所述前视声呐(5)扫描的二维声呐图像数据,提供声呐回波距离以及声呐图像测距功能,用于对所述水下机器人(1)搭载的所述前视声呐(5)采集图像信息提取,进而获得声阴影和回波距离信息,通过二维声呐图像声阴影算法计算被检测物体高度信息,实现对水下被检测物体的三维信息的提取,为所述水下机器人(1)实现水下三维检测提供可靠依据。
实施例三:
本实施例与实施例一基本相同,特别之处在于:
参见图2,所述二维声呐图像声阴影算法,具体过程如下:
(a)固定前视声呐和三维云台的垂直监测夹角;移动水下机器人朝着被检测物体;通过前视声呐向被检测物体发射声波信息。
(b)通过前视声呐获得回波信号,在上位机中显示测得的声呐二维图像,并测得声呐到被检测物体的回波距离,被检测物体的切面长度,声阴影的长度。
(c)图2中O点表示被检测物体的左下角,O1点表示被检测物体的右上角,m点表示第一次采集时声波到物体左侧的点,n点表示第二次采集时声波到物体左侧的点,x1点表示第一次采集时图像中声阴影的最远点,x2点表示第二次采集时图像中声阴影的最远点,R0,R1线段表示第一次采集时被检测物体到声呐的回波距离,R2,R3线段表示第二次采集时被检测物体到声呐的回波距离,r1线段表示第一次采集时声阴影长度,r2线段表示第二次采集时声阴影长度,D1表示第一次采集时被检测物体在图像中的切面长度,D2表示第二次采集时被检测物体在图像中的切面长度,h表示被检测物体的高度。
(d)根据余弦定理:,其中α表示三角形角度,a表示角度α对边,b,c表示角度α邻边,结合图2中,已知回波距离R0、R1和图像中被检测物体切面D1的距离,可以获得回波距离R0和R1之间的夹角θ1,同理已知回波距离R2、R3和图像中被检测物体切面D2的距离,可以获得回波距离R2和R3之间的夹角θ2。
(e)根据余弦定理,已知回波距离R0、R1和两者夹角θ1,可以获得线段mx1的长度,同理已知回波距离R2、R3和两者夹角θ2,可以获得线段nx2的长度。
(f)根据余弦定理,已知线段mx1的长度,被检测物体切面长度D1和声阴影信息r1,可以获得线段mx1和r1之间的夹角θ3,同理已知线段nx2的长度,被检测物体切面长度D2和声阴影信息r2,可以获得线段nx2和r2之间的夹角θ4。
(g)根据已知线段mx1和θ3计算出第一次采集被检测物体的高度信息,同理已知线段nx2和θ4计算出第二次采集被检测物体的高度信息,并根据两次采集高度信息求均值计算出被检测物体的高度信息。
(h)返回(d)运行。
以上通过具体实施方式对本发明进行了详细的说明,但这些并非构成对本发明的限制。在不脱离本发明原理的情况下,本领域的技术人员还可做出许多变形和改进,这些也应视为本发明的保护范围。
Claims (1)
1.一种基于移动前视声呐的水下三维检测系统, 包括:一个水下机器人(1)、一个捷联惯导系统(2)、一个三维云台(3)、一个姿态传感器(4)、一个前视声呐(5)、一个上位机(6),其特征在于:
1) 所述水下机器人(1)具有多轴螺旋桨驱动,可实现自身姿态和运动控制,通过以太网与所述上位机(6)相连;
2)所述捷联惯导系统(2)搭载于所述水下机器人(1)上,内含有速度陀螺,加速度计和微型计算机,用于测量所述水下机器人(1)的角运动和线运动信息;
3)所述三维云台(3)安装于所述水下机器人(1)下,用于装载所述前视声呐(5),通过所述捷联惯导系统(2)和所述姿态传感器(4)综合信息,控制所述三维云台(3)位姿,以实现对所述前视声呐(5)探测角度的自动调节,用于所述水下机器人(1)在水下涌流中调节姿态以保持所述前视声呐(5)既定探测角度;
4)所述姿态传感器(4)安装于所述三维云台(3)的内部,内含有陀螺仪和加速度计运动传感器,用于获取所述水下机器人(1)的姿态信息;
5)所述前视声呐(5)安装于所述三维云台(3)上,可进行既定的扫描角度和扫描范围,通过发射声脉冲并接受不同位置回波信号完成水下信息采集;
6)所述上位机(6)用于远程控制所述水下机器人(1)和接收声呐数据,显示所述前视声呐(5)扫描的二维声呐图像数据,提供声呐回波距离以及声呐图像测距功能,用于对所述水下机器人(1)搭载的所述前视声呐(5)采集图像信息提取,进而获得声阴影和回波距离信息,通过二维声呐图像声阴影算法计算被检测物体高度信息,实现对水下被检测物体的三维信息的提取;所述前视声呐(5)接收的不同位置回波信号距离,所述上位机(6)中被检测物体的切面长度和声阴影长度用于实现水下物体的高度信息检测。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910402909.2A CN110133667B (zh) | 2019-05-15 | 2019-05-15 | 基于移动前视声呐的水下三维检测系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910402909.2A CN110133667B (zh) | 2019-05-15 | 2019-05-15 | 基于移动前视声呐的水下三维检测系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110133667A CN110133667A (zh) | 2019-08-16 |
CN110133667B true CN110133667B (zh) | 2023-07-18 |
Family
ID=67574101
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910402909.2A Active CN110133667B (zh) | 2019-05-15 | 2019-05-15 | 基于移动前视声呐的水下三维检测系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110133667B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111206636B (zh) * | 2020-03-12 | 2021-08-13 | 广东新拓计算机科技有限公司 | 一种河道清淤机器人及无人船 |
CN112526490B (zh) * | 2020-12-11 | 2021-12-03 | 上海大学 | 一种基于计算机视觉的水下小目标声呐探测系统与方法 |
CN113379710B (zh) * | 2021-06-18 | 2024-02-02 | 上海大学 | 一种水下目标声呐精准测量系统和方法 |
CN114494603A (zh) * | 2022-02-11 | 2022-05-13 | 哈尔滨工程大学 | 基于Unity3D的仿真声呐图像数据生成方法 |
CN115303451A (zh) * | 2022-07-22 | 2022-11-08 | 深圳鳍源科技有限公司 | 水下设备以及水下作业系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5200931A (en) * | 1991-06-18 | 1993-04-06 | Alliant Techsystems Inc. | Volumetric and terrain imaging sonar |
CN102975833A (zh) * | 2012-12-10 | 2013-03-20 | 上海大学 | 用于水下目标探测与处置的遥操作无人潜水器 |
CN104777845A (zh) * | 2015-04-15 | 2015-07-15 | 上海海事大学 | 水下机器人的水下本体装置及自主避障方法 |
CN107153192A (zh) * | 2017-03-31 | 2017-09-12 | 大鹏高科(武汉)智能装备有限公司 | 一种水下机器人目标定位识别方法和系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070159922A1 (en) * | 2001-06-21 | 2007-07-12 | Zimmerman Matthew J | 3-D sonar system |
-
2019
- 2019-05-15 CN CN201910402909.2A patent/CN110133667B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5200931A (en) * | 1991-06-18 | 1993-04-06 | Alliant Techsystems Inc. | Volumetric and terrain imaging sonar |
CN102975833A (zh) * | 2012-12-10 | 2013-03-20 | 上海大学 | 用于水下目标探测与处置的遥操作无人潜水器 |
CN104777845A (zh) * | 2015-04-15 | 2015-07-15 | 上海海事大学 | 水下机器人的水下本体装置及自主避障方法 |
CN107153192A (zh) * | 2017-03-31 | 2017-09-12 | 大鹏高科(武汉)智能装备有限公司 | 一种水下机器人目标定位识别方法和系统 |
Non-Patent Citations (3)
Title |
---|
一种高精度水下成像声呐性能实验研究;翟京生等;《振动与冲击》;20180128;第37卷(第02期);全文 * |
三维成像声呐的设计与实现;桑恩方等;《哈尔滨工程大学学报》;20030630;第24卷(第03期);全文 * |
侧扫声呐图像的三维重构;王杰英;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20181215(第12期);正文第33-36页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110133667A (zh) | 2019-08-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110133667B (zh) | 基于移动前视声呐的水下三维检测系统 | |
CN110275169B (zh) | 一种水下机器人近场检测感知系统 | |
JP6057905B2 (ja) | 水中構造物の構造的変化の検出 | |
JP5886303B2 (ja) | 水中構造物の3次元モデルの構築 | |
US8655022B2 (en) | System and method for detecting position of underwater vehicle | |
JP2013545096A (ja) | 水中構造物に対する水中航走体の位置および向きの推定 | |
CN109709574B (zh) | 一种海底微地形激光扫描成像系统及三维地形重建方法 | |
CN114488164B (zh) | 水下航行器同步定位与建图方法及水下航行器 | |
CN111572737B (zh) | 一种基于声学和光学引导的auv捕获引导方法 | |
US11733041B2 (en) | Apparatus and method for fault-proof collection of imagery for underwater survey | |
US10488503B2 (en) | Surface mapping systems and methods using dynamic thresholds | |
CN108827252B (zh) | 绘制水下实景地图的方法、装置、设备、系统及存储介质 | |
CN110412584A (zh) | 一种水下前视声呐移动快速拼接系统 | |
US11280905B2 (en) | Underwater imaging system with multiple connected autonomous underwater vehicles | |
KR20200090565A (ko) | 3자 시점 카메라를 갖는 스마트 수중 드론 시스템 | |
US20200056890A1 (en) | Mapping and tracking methods and systems principally for use in connection with swimming pools and spas | |
CN108227744B (zh) | 一种水下机器人定位导航系统及定位导航方法 | |
AU2021307545A1 (en) | System and method for geolocation of an object in water | |
CN116400361A (zh) | 一种基于声呐探测的目标三维重构系统与方法 | |
JP6423703B2 (ja) | 形状計測システムおよび形状計測方法 | |
Kondo et al. | Structure tracing with a ranging system using a sheet laser beam | |
Kim et al. | Imaging sonar based navigation method for backtracking of AUV | |
KR20210099817A (ko) | 사이드 스캔소나를 이용한 이식 키조개 자원량 산정방법 | |
JP7336788B2 (ja) | 水中画像生成方法及びプログラム | |
Kondo et al. | Relative navigation of an AUV using a light-section ranging system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |