CN111721259A - 基于双目视觉的水下机器人回收定位方法 - Google Patents
基于双目视觉的水下机器人回收定位方法 Download PDFInfo
- Publication number
- CN111721259A CN111721259A CN202010594951.1A CN202010594951A CN111721259A CN 111721259 A CN111721259 A CN 111721259A CN 202010594951 A CN202010594951 A CN 202010594951A CN 111721259 A CN111721259 A CN 111721259A
- Authority
- CN
- China
- Prior art keywords
- image
- light source
- pixel
- camera
- underwater
- 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.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T7/00—Image analysis
- G06T7/80—Analysis of captured images to determine intrinsic or extrinsic camera parameters, i.e. camera calibration
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Theoretical Computer Science (AREA)
- Electromagnetism (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Image Processing (AREA)
Abstract
本发明提供一种基于双目视觉的水下机器人回收定位方法,利用两台水下CCD相机拍摄标定板,获取双目相机的参数,包括内、外参矩阵,畸变系数和相机之间的旋转、平移矩阵;获取水下双目相机拍摄的视觉图像,作为待分析的输入图像;灰度化与二值化处理输入图像,判断图像中的连通域;光源匹配,对水下图像进行形态学上的处理,获取最终光源中心点坐标;解算AUV与对接坞的相对位置。该方法将短距离高精度的双目视觉定位运用到水下AUV回收的自主对接过程中,利用质心检测算法、连通域检测算法替换Hough圆形检测法以提高计算AUV与对接坞的相对位置信息的实时性,提高了定位的实时性与稳定性,保障了AUV对接成功率。
Description
技术领域
本发明涉及一种基于双目视觉的水下机器人回收定位方法,属于水下机器人回收技术领域。
背景技术
自主式水下机器人(AUV:Autonomous Underwater Vehicle)无人无缆工作在海洋环境中,对于AUV的回收再利用工作是AUV研究及便捷化的重要研究内容之一。近年来,水下光视觉取得了丰富的研究成果,但由于水中环境的光线较暗、悬浮生物较多等干扰因素,使得采集到的图像噪声严重、颜色失真,这些都对水下景物的描述和目标定位产生很大的影响,从而影响水下机器人作业任务和水下机器人的回收工作。
因此,研究水下光视觉目标检测与定位***,以保证***测量精度、实时性和稳定性为目标,为水下机器人提供姿态信息和位置信息以便AUV的回收利用。所以水下视觉检测与目标定位技术对于短距离内的AUV回收定位具有重要的研究意义和使用价值。
发明内容
本发明的目的是为了提供一种基于双目视觉的水下机器人回收定位方法。本发明专利能为AUV提供精确的位置信息,以便AUV的回收,保障AUV的再次利用。
本发明的目的是这样实现的:这步骤如下:
步骤一:利用两台水下CCD相机拍摄标定板,获取双目相机的参数,包括内、外参矩阵,畸变系数和相机之间的旋转、平移矩阵;
步骤二:获取水下双目相机拍摄的视觉图像,作为待分析的输入图像;
步骤三:灰度化与二值化处理输入图像,判断图像中的连通域;
步骤四:光源匹配,对水下图像进行形态学上的处理,获取最终光源中心点坐标;
步骤五:解算AUV与对接坞的相对位置。
综上,本发明主要用于自主式水下机器人在完成相应的水下任务后,对其进行回收过程中,准确获取对接坞的位置信息。这样的过程包含以下步骤:水下双目相机的标定:计算出双目相机的内外参数;双目图像的矫正:畸变校正与立体矫正;双目图像的特征点匹配:形态学处理获取光源信息,质心检测获取光源中心的图像坐标,中心点匹配,去除误匹配;计算对接坞相对自主式水下机器人的位置信息;信息融合:利用卡尔曼滤波融合视觉定位与航位推算定位数据用以优势互补。
航位推算定位的优点在于数据更新频率高。具有较高的***频带,导航数据输出平稳,短期性较好。能够提供AUV与对接装置的相对位置姿态,这是对接过程一切行为的基础。采用此方法,将很大程度上弥补光视觉定位效率低,稳定性差缺点。
本发明与现有技术相比,具有一下优点:
(1)本发明结合计算机视觉技术与信息融合技术,实现AUV水下对接过程中的实时定位,提高其定位精度,弥补了单一视觉定位的更新周期长,鲁棒性差等缺点。
(2)传统的水下光源检测中运用Hough圆形检测,该方法计算量大,耗时长,本发明改用质心检测算法,计算速度快,实时响应高,提高定位的快速性。
(3)对于水下的特殊环境以及水质对光源的影响,本发明采用形态学上的腐蚀、膨胀处理,消除光源边缘的不规则细小噪声,平滑光源轮廓,提高下一步质心检测的正确率,同时提高计算光源中心坐标的精度。
(4)在水下图像的二值化阶段,采用wallner快速自适应二值化算法,摒除传统水下图像二值化处理亮度不均问题,即减少或不会造成光源的遗漏。
附图说明
图1是本发明一种基于双目视觉的水下机器人回收定位方法的整体流程图;
图2是本发明基于张正友标定法制定的水下双目相机的标定的流程图;
图3是本发明光源中心坐标分类方法;
图4是本发明建立的双目视觉的一般模型;
图5是本发明视觉定位信息与航位推算定位信息融合处理流程图;
图6是本发明步骤三中计算连通域的方法的流程图。
具体实施方式
下面结合说明书附图对本发明作进一步阐述。
如图1至6所示,本发明一种基于双目视觉的水下机器人回收定位方法,具体包括如下步骤:
步骤一:利用两台水下CCD相机拍摄标定板,获取双目相机的参数,包括内、外参矩阵,畸变系数和相机之间的旋转、平移矩阵;
应用张正友平面标定法对摄像机基本参数进行标定,首先打印一张7*10黑白格相间的标定板并在水下从不同角度拍摄若干张标定板图像;检测出图像中的特征点以求解理想无畸变情况下的摄像机内外参数并用最大似然估计提升精度;应用最小二乘法求出实际的径向畸变系数;之后综合内外参数、畸变系数使用极大似然法,优化估计,提升估计精度;最后得出精确的相机内外参数和畸变系数。
步骤二:获取水下双目相机拍摄的视觉图像,作为待分析的输入图像;
步骤三:灰度化与二值化处理输入图像,判断图像中的连通域;
采用wallner自适应阈值二值化处理图像,得到较为明显的水下光源黑白图像,其中wallner算法具体为:
其中p(n)表示第n个像素点的灰度值,gs(n)表示二值化后的值,s表示第n个之前的像素数量,取s为图像宽度的八分之一,该算法的优点在于可以解决因光照角度而出现的亮暗不均问题;
利用连通域检测算法判断图像中白色区域的数量,该算法步骤如下:
(1)对图像进行逐像素扫描,若当前的像素值为0则移动到下一个扫描的位置;
(2)若当前像素值为1,则检查该像素左边与上边的两个邻接像素;
(3)考虑这两个像素的组合情况,若它们的像素都为0,则给予该像素新的标记用以表示一个新的连通域的开始;
(4)它们中间只有一个像素为1,则当前的像素标记为它们中为1的像素标记值;
(5)它们的像素值都为1且标记相同,则当前像素的标记为该标记;
(6)它们的像素值都为1但是标记不同,则将较小的值赋给当前像素;
(7)以上述为循环,找出所有的连通域,得到连通域的数量;
步骤四:光源匹配,在得到连通域的基础上,对二值化的光源图像进行平滑处理,获取最终光源中心点坐标;具体包括如下步骤:
(1)利用形态学的腐蚀算法消除光源附近的噪声,将光源的连通域完全凸显出来;
(2)利用形态学的膨胀算法,平滑光源连通域的边缘;
(4)标记光源坐标,将横坐标最大、最小分别标记为左与右,将纵坐标最小、最大分别标记为上与下;
(5)最后将双目相机中相同标记的光源坐标配对,即双目相机中获取的两幅图中的光源坐标进行配对;
步骤五:解算AUV与对接坞的相对位置;
假设摄像机的所在坐标系与世界坐标系重合,O1-X1Y1构成左摄像机的图像坐标系,焦距为f1。坐标系OC2-XC2YC2构成右摄像机的坐标系,其成像平面对应的坐标系为O2-X2Y2,焦距为fr,其在左右成像平面上的投影点Pl(Xl,Yl)和Pr(Xr,Yr),则左右摄像机的投影模型分别是:
将上式联立可以得到点P(x,y,z)与Pl(x,y,z)和Pr(x,y,z)的数学表达式:
将标定所得的左右摄像机的内外参数和匹配后的Pl(Xl,Yl)和Pr(Xr,Yr)就可以求得AUV的三维位置信息;
步骤六:将双目视觉得到的位置数据与航位推算得到位置数据融合;具体包括如下步骤:
(1)选择对接过程中的位姿信息作为卡尔曼滤波的状态变量:X=[ξ η ζ ψ]T
φη、φζ、φψ与φξ相同,只是相对应的替换即可;
控制矩阵U(k)=diag{Uξ,Uη,Uζ,Uψ},其中:
Uη、Uζ、Uψ与Uξ相同,只是将相对应的替换即可。上两式中,T为采样时间,τaξ、τaξ、τaζ、τaψ分别是四个自由度加速度变化率相关事件常数;a=[aξ aη aζ aψ]为各自由度加速度;
(3)建立观测方程:将视觉导航给出的信息看作对***的观测量,包含位置信息和姿态信息,得到***的观测方程:Z(k)=HX(k)+V(k)
其中,Z=[ξobs ηobs ζobs ψobs]T,
上面结合附图对本发明的实施方式做了详细说明,但是本发明并不限于上述实施方式,在所属领域的技术人员所具备的知识范围内,在不脱离本发明宗旨的前提下可以做出各种变化。
Claims (7)
1.一种基于双目视觉的水下机器人回收定位方法,其特征在于,包括以下步骤:
步骤一:利用两台水下CCD相机拍摄标定板,获取双目相机的参数,包括内、外参矩阵,畸变系数和相机之间的旋转、平移矩阵;
步骤二:获取水下双目相机拍摄的视觉图像,作为待分析的输入图像;
步骤三:灰度化与二值化处理输入图像,判断图像中的连通域;
步骤四:光源匹配,对水下图像进行形态学上的处理,获取最终光源中心点坐标;
步骤五:解算AUV与对接坞的相对位置。
2.根据权利要求1所述的基于双目视觉的水下机器人回收定位方法,其中,步骤一中使用的张正友标定法获取相机的各项参数,具体步骤为:
打印一张7*10黑白格相间的标定板并在水下从不同角度拍摄若干张标定板图像;
检测出图像中的特征点以求解理想无畸变情况下的摄像机内外参数并用最大似然估计提升精度;
应用最小二乘法求出实际的径向畸变系数;
综合内外参数、畸变系数使用极大似然法,优化估计,提升估计精度,最后得出精确的相机内外参数和畸变系数。
4.根据权利要求3所述的基于双目视觉的水下机器人回收定位方法,其中,步骤三中使用连通域判断算法获取图像中连通域的数量即光源数量,该算法步骤如下:
对图像进行逐像素扫描,若当前的像素值为0则移动到下一个扫描的位置;
若当前像素值为1,则检查该像素左边与上边的两个邻接像素;
考虑这两个像素的组合情况,若它们的像素都为0,则给予该像素新的标记用以表示一个新的连通域的开始;
它们中间只有一个像素为1,则当前的像素标记为它们中为1的像素标记值;
它们的像素值都为1且标记相同,则当前像素的标记为该标记;
它们的像素值都为1但是标记不同,则将较小的值赋给当前像素;
以上述为循环,找出所有的连通域,得到连通域的数量。
5.根据权利要求1所述的基于双目视觉的水下机器人回收定位方法,其中,步骤四中在得到连通域的基础上,对二值化的光源图像进行平滑处理,利用图像处理中形态学上的腐蚀、膨胀操作,消除光源所在的连通域周围的像素噪声,凸显光源所在连通域并平滑光源边缘。
7.根据权利要求1所述的基于双目视觉的水下机器人回收定位方法,其中,步骤五中,假设做摄像机的所在坐标系与世界坐标系重合,O1-X1Y1构成左摄像机的图像坐标系,焦距为f1。坐标系OC2-XC2YC2构成右摄像机的坐标系,其成像平面对应的坐标系为O2-X2Y2,焦距为fr,其在左右成像平面上的投影点Pl(Xl,Yl)和Pr(Xr,Yr),则左右摄像机的投影模型分别是:
将上式联立可以得到点P(x,y,z)与Pl(x,y,z)和Pr(x,y,z)的数学表达式:
将标定所得的左右摄像机的内外参数和匹配后的Pl(Xl,Yl)和Pr(Xr,Yr)就可以求得AUV的三维位置信息。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010594951.1A CN111721259B (zh) | 2020-06-24 | 2020-06-24 | 基于双目视觉的水下机器人回收定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010594951.1A CN111721259B (zh) | 2020-06-24 | 2020-06-24 | 基于双目视觉的水下机器人回收定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111721259A true CN111721259A (zh) | 2020-09-29 |
CN111721259B CN111721259B (zh) | 2022-05-03 |
Family
ID=72568964
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010594951.1A Active CN111721259B (zh) | 2020-06-24 | 2020-06-24 | 基于双目视觉的水下机器人回收定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111721259B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111784655A (zh) * | 2020-06-24 | 2020-10-16 | 江苏科技大学 | 一种水下机器人回收定位方法 |
CN112215901A (zh) * | 2020-10-09 | 2021-01-12 | 哈尔滨工程大学 | 一种用于水下标定的多功能标定板装置 |
CN112634377A (zh) * | 2020-12-28 | 2021-04-09 | 深圳市杉川机器人有限公司 | 扫地机器人的相机标定方法、终端和计算机可读存储介质 |
CN113034399A (zh) * | 2021-04-01 | 2021-06-25 | 江苏科技大学 | 基于双目视觉自主式水下机器人回收导引伪光源去除方法 |
CN113109762A (zh) * | 2021-04-07 | 2021-07-13 | 哈尔滨工程大学 | 一种用于auv对接回收的光视觉引导方法 |
CN113313116A (zh) * | 2021-06-20 | 2021-08-27 | 西北工业大学 | 一种基于视觉的水下人工目标准确检测与定位方法 |
CN113895594A (zh) * | 2021-09-22 | 2022-01-07 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种基于水下动态回收平台的auv回收方法 |
CN114638883A (zh) * | 2022-03-09 | 2022-06-17 | 西南交通大学 | 一种绝缘子水冲洗机器人视觉受限重定位目标方法 |
CN116452878A (zh) * | 2023-04-20 | 2023-07-18 | 广东工业大学 | 一种基于深度学习算法与双目视觉的考勤方法及*** |
CN116740334A (zh) * | 2023-06-23 | 2023-09-12 | 河北大学 | 一种基于双目视觉和改进yolo的无人机入侵检测定位方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103714345A (zh) * | 2013-12-27 | 2014-04-09 | Tcl集团股份有限公司 | 一种双目立体视觉检测手指指尖空间位置的方法与*** |
CN104091324A (zh) * | 2014-06-16 | 2014-10-08 | 华南理工大学 | 一种基于连通域分割的棋盘格图像快速特征匹配算法 |
CN104182982A (zh) * | 2014-08-27 | 2014-12-03 | 大连理工大学 | 双目立体视觉摄像机标定参数的整体优化方法 |
CN105225251A (zh) * | 2015-09-16 | 2016-01-06 | 三峡大学 | 基于机器视觉的超视距海上运动目标快速识别与定位装置及方法 |
CN108765495A (zh) * | 2018-05-22 | 2018-11-06 | 山东大学 | 一种基于双目视觉检测技术的快速标定方法及*** |
CN109242908A (zh) * | 2018-07-12 | 2019-01-18 | 中国科学院自动化研究所 | 用于水下双目视觉测量***的标定方法 |
US20190204084A1 (en) * | 2017-09-29 | 2019-07-04 | Goertek Inc. | Binocular vision localization method, device and system |
-
2020
- 2020-06-24 CN CN202010594951.1A patent/CN111721259B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103714345A (zh) * | 2013-12-27 | 2014-04-09 | Tcl集团股份有限公司 | 一种双目立体视觉检测手指指尖空间位置的方法与*** |
CN104091324A (zh) * | 2014-06-16 | 2014-10-08 | 华南理工大学 | 一种基于连通域分割的棋盘格图像快速特征匹配算法 |
CN104182982A (zh) * | 2014-08-27 | 2014-12-03 | 大连理工大学 | 双目立体视觉摄像机标定参数的整体优化方法 |
CN105225251A (zh) * | 2015-09-16 | 2016-01-06 | 三峡大学 | 基于机器视觉的超视距海上运动目标快速识别与定位装置及方法 |
US20190204084A1 (en) * | 2017-09-29 | 2019-07-04 | Goertek Inc. | Binocular vision localization method, device and system |
CN108765495A (zh) * | 2018-05-22 | 2018-11-06 | 山东大学 | 一种基于双目视觉检测技术的快速标定方法及*** |
CN109242908A (zh) * | 2018-07-12 | 2019-01-18 | 中国科学院自动化研究所 | 用于水下双目视觉测量***的标定方法 |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111784655A (zh) * | 2020-06-24 | 2020-10-16 | 江苏科技大学 | 一种水下机器人回收定位方法 |
CN112215901A (zh) * | 2020-10-09 | 2021-01-12 | 哈尔滨工程大学 | 一种用于水下标定的多功能标定板装置 |
CN112215901B (zh) * | 2020-10-09 | 2023-08-01 | 哈尔滨工程大学 | 一种用于水下标定的多功能标定板装置 |
CN112634377A (zh) * | 2020-12-28 | 2021-04-09 | 深圳市杉川机器人有限公司 | 扫地机器人的相机标定方法、终端和计算机可读存储介质 |
WO2022205525A1 (zh) * | 2021-04-01 | 2022-10-06 | 江苏科技大学 | 基于双目视觉自主式水下机器人回收导引伪光源去除方法 |
CN113034399A (zh) * | 2021-04-01 | 2021-06-25 | 江苏科技大学 | 基于双目视觉自主式水下机器人回收导引伪光源去除方法 |
CN113109762A (zh) * | 2021-04-07 | 2021-07-13 | 哈尔滨工程大学 | 一种用于auv对接回收的光视觉引导方法 |
CN113109762B (zh) * | 2021-04-07 | 2022-08-02 | 哈尔滨工程大学 | 一种用于auv对接回收的光视觉引导方法 |
CN113313116A (zh) * | 2021-06-20 | 2021-08-27 | 西北工业大学 | 一种基于视觉的水下人工目标准确检测与定位方法 |
CN113895594A (zh) * | 2021-09-22 | 2022-01-07 | 中国船舶重工集团公司第七0七研究所九江分部 | 一种基于水下动态回收平台的auv回收方法 |
CN114638883A (zh) * | 2022-03-09 | 2022-06-17 | 西南交通大学 | 一种绝缘子水冲洗机器人视觉受限重定位目标方法 |
CN114638883B (zh) * | 2022-03-09 | 2023-07-14 | 西南交通大学 | 一种绝缘子水冲洗机器人视觉受限重定位目标方法 |
CN116452878A (zh) * | 2023-04-20 | 2023-07-18 | 广东工业大学 | 一种基于深度学习算法与双目视觉的考勤方法及*** |
CN116452878B (zh) * | 2023-04-20 | 2024-02-02 | 广东工业大学 | 一种基于深度学习算法与双目视觉的考勤方法及*** |
CN116740334A (zh) * | 2023-06-23 | 2023-09-12 | 河北大学 | 一种基于双目视觉和改进yolo的无人机入侵检测定位方法 |
CN116740334B (zh) * | 2023-06-23 | 2024-02-06 | 河北大学 | 一种基于双目视觉和改进yolo的无人机入侵检测定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111721259B (zh) | 2022-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111721259B (zh) | 基于双目视觉的水下机器人回收定位方法 | |
CN111784655B (zh) | 一种水下机器人回收定位方法 | |
CN109255813B (zh) | 一种面向人机协作的手持物***姿实时检测方法 | |
CN110497187B (zh) | 基于视觉引导的太阳花模组装配*** | |
CN104484648B (zh) | 基于轮廓识别的机器人可变视角障碍物检测方法 | |
CN110648367A (zh) | 一种基于多层深度与彩色视觉信息的几何体目标定位方法 | |
CN107844750A (zh) | 一种水面全景图像目标检测识别方法 | |
CN108597009B (zh) | 一种基于方向角信息进行三维目标检测的方法 | |
CN111897349A (zh) | 一种基于双目视觉的水下机器人自主避障方法 | |
CN111862201A (zh) | 一种基于深度学习的空间非合作目标相对位姿估计方法 | |
CN112132874B (zh) | 无标定板异源图像配准方法、装置、电子设备及存储介质 | |
CN111627072A (zh) | 一种对多传感器进行标定的方法、装置和存储介质 | |
CN111179233B (zh) | 基于激光切割二维零部件的自适应纠偏方法 | |
CN106996748A (zh) | 一种基于双目视觉的轮径测量方法 | |
CN114029946A (zh) | 一种基于3d光栅引导机器人定位抓取的方法、装置及设备 | |
CN113324478A (zh) | 一种线结构光的中心提取方法及锻件三维测量方法 | |
CN115830018B (zh) | 基于深度学习与双目视觉的碳素块检测方法及*** | |
CN114140439A (zh) | 基于深度学习的激光焊接焊缝特征点识别方法及装置 | |
CN106952262B (zh) | 一种基于立体视觉的船板加工精度分析方法 | |
CN113313116B (zh) | 一种基于视觉的水下人工目标准确检测与定位方法 | |
CN108109154A (zh) | 一种工件的新型定位及数据获取方法 | |
CN115629066A (zh) | 一种基于视觉引导的面向自动配线的方法及装置 | |
CN111738971B (zh) | 一种基于线激光双目立体视觉的电路板立体扫描检测方法 | |
Li et al. | Vision-based target detection and positioning approach for underwater robots | |
CN112484680A (zh) | 一种基于圆检测的蓝宝石晶片定位跟踪方法 |
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 |