CN114237262A - 一种水面无人船自动停泊方法及*** - Google Patents
一种水面无人船自动停泊方法及*** Download PDFInfo
- Publication number
- CN114237262A CN114237262A CN202111608638.XA CN202111608638A CN114237262A CN 114237262 A CN114237262 A CN 114237262A CN 202111608638 A CN202111608638 A CN 202111608638A CN 114237262 A CN114237262 A CN 114237262A
- Authority
- CN
- China
- Prior art keywords
- positioning
- unmanned ship
- dimensional code
- gps
- visual
- 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
- 238000000034 method Methods 0.000 title claims abstract description 37
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 15
- 230000000007 visual effect Effects 0.000 claims abstract description 94
- 230000004927 fusion Effects 0.000 claims abstract description 50
- 238000011156 evaluation Methods 0.000 claims abstract description 14
- 230000008859 change Effects 0.000 claims description 22
- 238000003032 molecular docking Methods 0.000 claims description 21
- 238000012545 processing Methods 0.000 claims description 21
- 238000004364 calculation method Methods 0.000 claims description 16
- 238000001514 detection method Methods 0.000 claims description 13
- 230000000877 morphologic effect Effects 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 10
- 238000001914 filtration Methods 0.000 claims description 6
- 238000007781 pre-processing Methods 0.000 claims description 6
- 238000012795 verification Methods 0.000 claims description 6
- 238000013461 design Methods 0.000 claims description 3
- 238000012216 screening Methods 0.000 claims description 3
- 230000009286 beneficial effect Effects 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 3
- 238000011161 development Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000009466 transformation Effects 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供了一种水面无人船自动停泊方法及***,所述方法包括设定无人船返航停泊的停泊点;建立双二维码坐标系;在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。本发明的有益效果在于:通过视觉定位及与GPS定位相结合,获取到最优的定位精度,使得在定位信号较弱甚至没有定位信号的情况下无人船依然能获得精确度较高的定位信息,实现无人船精确定位及自动停泊控制。
Description
技术领域
本发明涉及一种自动停泊方法及***,尤其是指一种水面无人船自动停泊方法及***。
背景技术
近年来,随着移动机器人与自动驾驶技术的快速发展,水面自动驾驶无人船智能化发展也愈发得到重视,各种型号与用途的水面无人驾驶船也渐渐出现在各行各业的应用之中。无人船智能化技术的发展体现在无人驾驶技术的成熟应用,无人船自动停泊技术的应用则是其智能化的重要体现。当前,户外水面无人船的停泊、高精度定位主要依靠卫星定位导航。然而,在卫星定位信号弱、地面卫星基站信号覆盖薄弱、上方有物体遮挡的水面场景等等情形下,无人船定位精度降低甚至无卫星定位信息时,无人船定位信息无法准确获得。如何在定位信号较弱甚至没有定位信号的情况下无人船依然能获得精确度较高的定位信息是无人船精确定位及自动停泊控制领域的技术难点。
发明内容
本发明所要解决的技术问题是:提供了一种水面无人船自动停泊方法及***。
为了解决上述技术问题,本发明采用的技术方案为:一种水面无人船自动停泊方法,包括步骤,
S10、设定无人船返航停泊的停泊点;
S20、建立双二维码坐标系;
S30、在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;
S40、根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。
进一步的,步骤S10具体包括,
S11、预先初始化记录第一个二维码M1、第二个二维码M2、以及停泊点P三点的精确地GPS定位信息,并计算获得的一段连续定位信息的精度因子,以筛选获得停泊点P点的精度较高的定位经纬度信息,所述二维码M1及二维码M2设立在停泊点P两侧;
S12、计算垂直于双二维码连线位置的中垂线L在大地坐标系下的朝向角度α,计算生成停泊点P沿中垂线L方向上距离为z的第一停泊点P1。
进一步的,步骤S20具体包括,
S21、接收无人船的摄像机拍摄的图片,对图片进行图像预处理,对图片进行滤波后转为二值化图像,对二值化图像进行图像形态学处理;
S22、对进行形态学处理的图像进行SIFT角点检测与直线特征检测,对识别到的二维码内容进行提取,二维码是设立在停泊点P两侧的两个Aruco二维码;
S23、从二维码内容中获得每个二维码的位姿及二维码内容像素的大小对比二维码的大小,分别获得无人船与两个二维码之间的位姿;
S24、根据两个二维码的位姿及两个二维码之间的距离,建立以双二维码位置为坐标的双二维码坐标系,计算在双二维码坐标系下无人船的摄像头位置(x,y)及无人船的船头朝向β。
进一步的,步骤S30具体包括,
S31、测量视觉定位误差大小随z大小变化的曲线比例变化关系;
S32、计算GPS定位的误差大小与GPS信号强度的变化关系;
S33、计算对比视觉定位精度与GPS定位精度的误差大小,分别得到综合视觉定位与GPS定位的对比评价置信度分数;
S34、对比在同一时刻下视觉定位精度与GPS定位精度的置信度分数,设计双二维码视觉与GPS融合定位策略,以获得更高精度的无人船的定位信息。
进一步的,步骤S40具体包括,
S41、在智能移动终端上软件载入标记的停泊点P的返航停泊任务,并开始返航停泊任务;
S42、在无人船到达第一停泊点P1时,同时开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态地计算出视觉定位结果与GPS定位结果之间置信度分数最高的融合定位结果;
S43、根据实时动态的融合定位结果,计算并规划无人船最优的倒库停泊路线R;控制无人船沿着规划路线R行进停泊;
S44、对无人船是否停泊至停泊点P进行自主验证,通过验证视觉定位结果、GPS定位结果以及是否卡位,综合自主验证是否到达目标停泊点P,完成自动停泊过程。
本实施例中,通过在建立的双二维码坐标系下,进行视觉定位及与GPS定位,并对比出置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息,然后根据该定位信息,通过双二维码视觉与GPS融合定位策略控制无人船停泊到设定的停泊点。该过程中,通过视觉定位及与GPS定位相结合,获取到最优的定位精度,使得在定位信号较弱甚至没有定位信号的情况下无人船依然能获得精确度较高的定位信息,实现无人船精确定位及自动停泊控制。
本发明还提供了一种水面无人船自动停泊***,包括,
停泊点设定模块,用于设定无人船返航停泊的停泊点;
坐标系建立模块,用于建立双二维码坐标系;
定位信息计算模块,用于在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;
停泊控制模块,用于根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。
进一步的,停泊点设定模块具体包括,
GPS定位信息记录单元,用于预先初始化记录第一个二维码M1、第二个二维码M2、以及停泊点P三点的精确地GPS定位信息,并计算获得的一段连续定位信息的精度因子,以筛选获得停泊点P点的精度较高的定位经纬度信息,所述二维码M1及二维码M2设立在停泊点P两侧;
第一停泊点计算单元,用于计算垂直于双二维码连线位置的中垂线L在大地坐标系下的朝向角度α,计算生成停泊点P沿中垂线L方向上距离为z的第一停泊点P1。
进一步的,坐标系建立模块具体包括,
图片处理单元,接收无人船的摄像机拍摄的图片,对图片进行图像预处理,对图片进行滤波后转为二值化图像,对二值化图像进行图像形态学处理;
图片信息获取单元,用于对进行形态学处理的图像进行SIFT角点检测与直线特征检测,对识别到的二维码内容进行提取,二维码是设立在停泊点P两侧的两个Aruco二维码;
图片信息计算单元,用于从二维码内容中获得每个二维码的位姿及二维码内容像素的大小对比二维码的大小,分别获得无人船与两个二维码之间的位姿;
坐标系形成单元,用于根据两个二维码的位姿及两个二维码之间的距离,建立以双二维码位置为坐标的双二维码坐标系,计算在双二维码坐标系下无人船的摄像头位置(x,y)及无人船的船头朝向β。
进一步的,定位信息计算模块具体包括,
视觉定位误差曲线测量单元,用于测量视觉定位误差大小随z大小变化的曲线比例变化关系;
GPS定位误差计算单元,用于计算GPS定位的误差大小与GPS信号强度的变化关系;
置信度分数计算单元,用于计算对比视觉定位精度与GPS定位精度的误差大小,分别得到综合视觉定位与GPS定位的对比评价置信度分数;
融合定位策略设计单元,用于对比在同一时刻下视觉定位精度与GPS定位精度的置信度分数,设计双二维码视觉与GPS融合定位策略,以获得更高精度的无人船的定位信息。
进一步的,停泊控制模块具体包括,
停泊任务载入单元,用于在智能移动终端上软件载入标记的停泊点P的返航停泊任务,并开始返航停泊任务;
融合定位单元,用于在无人船到达第一停泊点P1时,同时开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态地计算出视觉定位结果与GPS定位结果之间置信度分数最高的融合定位结果;
停泊规划单元,用于根据实时动态的融合定位结果,计算并规划无人船最优的倒库停泊路线R,控制无人船沿着规划路线R行进停泊;
停泊验证单元,用于对无人船是否停泊至停泊点P进行自主验证,通过验证视觉定位结果、GPS定位结果以及是否卡位,综合自主验证是否到达目标停泊点P,完成自动停泊过程。
本发明的有益效果在于:通过在建立的双二维码坐标系下,进行视觉定位及与GPS定位,并对比出置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息,然后根据该定位信息,通过双二维码视觉与GPS融合定位策略控制无人船停泊到设定的停泊点。该过程中,通过视觉定位及与GPS定位相结合,获取到最优的定位精度,使得在定位信号较弱甚至没有定位信号的情况下无人船依然能获得精确度较高的定位信息,实现无人船精确定位及自动停泊控制。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图示出的机构获得其他的附图。
图1为本发明实施例的水面无人船自动停泊方法流程图;
图2为本发明实施例的水面无人船自动停泊方***框图;
图3为本发明实施例的水面无人船的位置示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
需要说明,本发明中涉及“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。另外,各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本发明要求的保护范围之内。
如图1、图3所示,本发明的第一实施例为:一种水面无人船自动停泊方法,包括步骤,
S10、设定无人船返航停泊的停泊点;
S20、建立双二维码坐标系;
S30、在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;
S40、根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。
其中,步骤S10具体包括,
S11、预先初始化记录第一个二维码M1、第二个二维码M2、以及停泊点P三点的精确地GPS定位信息,并计算获得的一段连续定位信息的精度因子Ni,向量或向量组合,形成一段长时间内连续稳定的定位信息精度因子列表依据正态分布的方法:得到这段连续稳定的定位信息精度因子数据中的期望值,即出现次数最多的定位信息的精度因子,即获得该精度因子对应GPS定位经纬度信息分别对应作为停泊点P、第一个二维码M1以及第二个二维码M2的经纬度坐标。二维码M1及二维码M2设立在停泊点P两侧;
S12、计算垂直于双二维码连线位置的中垂线L在大地坐标系下的朝向角度α,计算生成停泊点P沿中垂线L方向上距离为z的第一停泊点P1。
其中,步骤S20具体包括,
S21、接收无人船的摄像机拍摄的图片,对图片进行图像预处理,将无人船的摄像头采集的图片转换成灰度图,对图片进行噪点滤波后转为二值化图像,对二值化图像进行图像形态学处理;
S22、对进行形态学处理的图像进行SIFT角点检测与直线特征检测,以获得每个二维码的四个角点,使用直线特征检测的霍夫变换方法,对识别到的二维码内容中的黑白界线进行提取,以得到二维码内外轮廓;该二维码是设立在停泊点P两侧的两个Aruco二维码;
S23、从二维码内容中获得每个二维码的位姿及二维码内容像素的大小对比二维码的大小,分别获得无人船与两个二维码之间的位姿;具体为:
得到的具有形变特征的二维码计算位姿信息,通过建立形变二维码的坐标系与无人船上摄像头的坐标系,计算两个坐标系之间的空间转换关系,以获得每个Aruco二维码在无人船上固定安装的摄像头坐标系下的位姿;空间三维坐标变换原理:
通过三维坐标变化的数学关系,可得到上述二维码坐标系相对于摄像头坐标系的位姿;以提取的二维码内容像素的大小对比二维码的大小,获得两个二维码的距离大小;
S24、根据两个二维码的位姿及两个二维码之间的距离,建立以上述双二维码(M1-M2)连线为X轴、以停泊点P为坐标原点、以中垂线L为Y轴的双二维码坐标系;并计算在建立的双二维码坐标系下无人船摄像头的位置(x,y)与无人船船头朝向β;
其中,步骤S30具体包括,
S31、测量视觉定位误差大小随z大小变化的曲线比例变化关系;具体为:测量在停泊点P与第一停泊点P1之间z距离范围内不同位置处无人船的视觉定位误差;得到不同位置、不同无人船摄像头朝向角时的真实坐标(xt,yt)与视觉定位得到的视觉坐标(xCV,yCV),可得该位置处视觉定位坐标误差为(Δx,Δy):
(Δx,Δy)=(xCV,yCV)-(xt,yt)
S32、计算GPS定位的误差大小与GPS信号强度的变化关系;具体为:
计算不同强度GPS定位信号条件下的GPS信号,通过GnGST数据中的lat dev和lngdev计算得出,公式为:
得到GPS定位位置(latGPS,lngGPS)真实的误差大小与GPS信号强度的变化关系;
S33、计算对比视觉定位精度与GPS定位精度的误差大小,分别得到综合视觉定位与GPS定位的对比评价置信度分数;具体为:
计算视觉定位精度与GPS定位精度的真实误差大小,转换为以厘米(cm)为距离单位以度量和比较视觉定位误差与GPS定位误差的真实大小,以此分别计算得到综合视觉定位与GPS定位的对比评价置信度分数;
S34、对比在同一时刻下视觉定位精度与GPS定位精度的置信度分数,设计双二维码视觉与GPS融合定位策略,以获得更高精度的无人船的定位信息,具体为:
双二维码视觉与GPS融合定位策略,将视觉定位结果(xCV,yCV)通过二维坐标系旋转转换、直角坐标系转北东坐标系转换为经纬度坐标系下坐标(latCV,lngCV),二维坐标系旋转转换计算形式如下:
依据在同一时刻时的视觉定位精度置信度分数KCV,以及得到的GPS定位精度置信度分数KGPS,结合同一时间实时的视觉初始定位结果与GPS初始定位结果,对比二者置信度分数大小:
若KCV>KGPS则将视觉定位方法对应当前时刻的初始定位结果(latCV,lngCV)作为无人船此刻的准确定位(lat,lng);
若KCV<KGPS则将GPS定位方法对应当前时刻的初始定位结果(latGPS,lngGPS)作为无人船此刻的准确定位(lat,lng)。
其中,步骤S40具体包括,
S41、在智能移动终端上软件载入标记的停泊点P的返航停泊任务,并开始返航停泊任务;
S42、在无人船到达第一停泊点P1时,同时开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态地计算出视觉定位结果与GPS定位结果之间置信度分数最高的融合定位结果;具体为:
无人船到达第一停泊点P1,此时无人船的真实位置S与P1点会存在一定的位置偏移;随后开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态的计算出视觉定位与GPS定位二者中最高置信度分数对应的定位结果作为无人船真实位置点S处最终的经纬度坐标(lat,lng);图示箭头方向为此时的无人船朝向,与中垂线L的夹角即为无人船船头朝向β;
S43、根据实时动态的融合定位结果,计算并规划无人船最优的倒库停泊路线R;控制无人船沿着规划路线R行进停泊;具体为:
根据实时动态的融合定位结果,已知停泊点P与第一停泊点P1连线(P-P1)的经纬度与大地坐标系下的方向α,以及无人船的经纬度位置(lat,lng),计算并规划无人船最优的倒库停泊路线R;控制无人船沿着规划路线行进停泊;
S44、对无人船是否停泊至停泊点P进行自主验证,通过验证视觉定位结果、GPS定位结果以及是否卡位,综合自主验证是否到达目标停泊点P,完成自动停泊过程。
如图2、图3所示,本发明的另一实施例为:一种水面无人船自动停泊***,包括,
停泊点设定模块,用于设定无人船返航停泊的停泊点;
坐标系建立模块,用于建立双二维码坐标系;
定位信息计算模块,用于在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;
停泊控制模块,用于根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。
其中,停泊点设定模块具体包括,
GPS定位信息记录单元,用于预先初始化记录第一个二维码M1、第二个二维码M2、以及停泊点P三点的精确地GPS定位信息,并计算获得的一段连续定位信息的精度因子,以筛选获得停泊点P点的精度较高的定位经纬度信息,所述二维码M1及二维码M2设立在停泊点P两侧;
第一停泊点计算单元,用于计算垂直于双二维码连线位置的中垂线L在大地坐标系下的朝向角度α,计算生成停泊点P沿中垂线L方向上距离为z的第一停泊点P1。
其中,坐标系建立模块具体包括,
图片处理单元,接收无人船的摄像机拍摄的图片,对图片进行图像预处理,对图片进行滤波后转为二值化图像,对二值化图像进行图像形态学处理;
图片信息获取单元,用于对进行形态学处理的图像进行SIFT角点检测与直线特征检测,对识别到的二维码内容进行提取,二维码是设立在停泊点P两侧的两个Aruco二维码;
图片信息计算单元,用于从二维码内容中获得每个二维码的位姿及二维码内容像素的大小对比二维码的大小,分别获得无人船与两个二维码之间的位姿;
坐标系形成单元,用于根据两个二维码的位姿及两个二维码之间的距离,建立以双二维码位置为坐标的双二维码坐标系,计算在双二维码坐标系下无人船的摄像头位置(x,y)及无人船的船头朝向β。
其中,定位信息计算模块具体包括,
视觉定位误差曲线测量单元,用于测量视觉定位误差大小随z大小变化的曲线比例变化关系;
GPS定位误差计算单元,用于计算GPS定位的误差大小与GPS信号强度的变化关系;
置信度分数计算单元,用于计算对比视觉定位精度与GPS定位精度的误差大小,分别得到综合视觉定位与GPS定位的对比评价置信度分数;
融合定位策略设计单元,用于对比在同一时刻下视觉定位精度与GPS定位精度的置信度分数,设计双二维码视觉与GPS融合定位策略,以获得更高精度的无人船的定位信息。
其中,停泊控制模块具体包括,
停泊任务载入单元,用于在智能移动终端上软件载入标记的停泊点P的返航停泊任务,并开始返航停泊任务;
融合定位单元,用于在无人船到达第一停泊点P1时,同时开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态地计算出视觉定位结果与GPS定位结果之间置信度分数最高的融合定位结果;
停泊规划单元,用于根据实时动态的融合定位结果,计算并规划无人船最优的倒库停泊路线R,控制无人船沿着规划路线R行进停泊;
停泊验证单元,用于对无人船是否停泊至停泊点P进行自主验证,通过验证视觉定位结果、GPS定位结果以及是否卡位,综合自主验证是否到达目标停泊点P,完成自动停泊过程。
需要说明的是,所属领域的技术人员可以清楚地了解到,上述水面无人船自动停泊***的具体实现过程,可以参考前述方法实施例中的相应描述,为了描述的方便和简洁,在此不再赘述。
以上所述仅为本发明的实施例,并非因此限制本发明的专利范围,凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换,或直接或间接运用在其他相关的技术领域,均同理包括在本发明的专利保护范围内。
Claims (10)
1.一种水面无人船自动停泊方法,其特征在于:包括步骤,
S10、设定无人船返航停泊的停泊点;
S20、建立双二维码坐标系;
S30、在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;
S40、根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。
2.如权利要求1所述的水面无人船自动停泊方法,其特征在于:步骤S10具体包括,
S11、预先初始化记录第一个二维码M1、第二个二维码M2、以及停泊点P三点的精确地GPS定位信息,并计算获得的一段连续定位信息的精度因子,以筛选获得停泊点P点的精度较高的定位经纬度信息,所述二维码M1及二维码M2设立在停泊点P两侧;
S12、计算垂直于双二维码连线位置的中垂线L在大地坐标系下的朝向角度α,计算生成停泊点P沿中垂线L方向上距离为z的第一停泊点P1。
3.如权利要求1所述的水面无人船自动停泊方法,其特征在于:步骤S20具体包括,
S21、接收无人船的摄像机拍摄的图片,对图片进行图像预处理,对图片进行滤波后转为二值化图像,对二值化图像进行图像形态学处理;
S22、对进行形态学处理的图像进行SIFT角点检测与直线特征检测,对识别到的二维码内容进行提取,二维码是设立在停泊点P两侧的两个Aruco二维码;
S23、从二维码内容中获得每个二维码的位姿及二维码内容像素的大小对比二维码的大小,分别获得无人船与两个二维码之间的位姿;
S24、根据两个二维码的位姿及两个二维码之间的距离,建立以双二维码位置为坐标的双二维码坐标系,计算在双二维码坐标系下无人船的摄像头位置(x,y)及无人船的船头朝向β。
4.如权利要求1所述的水面无人船自动停泊方法,其特征在于:步骤S30具体包括,
S31、测量视觉定位误差大小随z大小变化的曲线比例变化关系;
S32、计算GPS定位的误差大小与GPS信号强度的变化关系;
S33、计算对比视觉定位精度与GPS定位精度的误差大小,分别得到综合视觉定位与GPS定位的对比评价置信度分数;
S34、对比在同一时刻下视觉定位精度与GPS定位精度的置信度分数,设计双二维码视觉与GPS融合定位策略,以获得更高精度的无人船的定位信息。
5.如权利要求1所述的水面无人船自动停泊方法,其特征在于:步骤S40具体包括,
S41、在智能移动终端上软件载入标记的停泊点P的返航停泊任务,并开始返航停泊任务;
S42、在无人船到达第一停泊点P1时,同时开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态地计算出视觉定位结果与GPS定位结果之间置信度分数最高的融合定位结果;
S43、根据实时动态的融合定位结果,计算并规划无人船最优的倒库停泊路线R;控制无人船沿着规划路线R行进停泊;
S44、对无人船是否停泊至停泊点P进行自主验证,通过验证视觉定位结果、GPS定位结果以及是否卡位,综合自主验证是否到达目标停泊点P,完成自动停泊过程。
6.一种水面无人船自动停泊***,其特征在于:包括步骤,
停泊点设定模块,用于设定无人船返航停泊的停泊点;
坐标系建立模块,用于建立双二维码坐标系;
定位信息计算模块,用于在双二维码坐标系下,计算视觉定位与GPS定位的对比评价置信度分数,设计双二维码视觉与GPS融合定位策略,以获得无人船的定位信息;
停泊控制模块,用于根据无人船的定位信息,通过GPS融合定位策略控制无人船停泊到设定的停泊点。
7.如权利要求6所述的水面无人船自动停泊***,其特征在于:停泊点设定模块具体包括,
GPS定位信息记录单元,用于预先初始化记录第一个二维码M1、第二个二维码M2、以及停泊点P三点的精确地GPS定位信息,并计算获得的一段连续定位信息的精度因子,以筛选获得停泊点P点的精度较高的定位经纬度信息,所述二维码M1及二维码M2设立在停泊点P两侧;
第一停泊点计算单元,用于计算垂直于双二维码连线位置的中垂线L在大地坐标系下的朝向角度α,计算生成停泊点P沿中垂线L方向上距离为z的第一停泊点P1。
8.如权利要求6所述的水面无人船自动停泊***,其特征在于:坐标系建立模块具体包括,
图片处理单元,接收无人船的摄像机拍摄的图片,对图片进行图像预处理,对图片进行滤波后转为二值化图像,对二值化图像进行图像形态学处理;
图片信息获取单元,用于对进行形态学处理的图像进行SIFT角点检测与直线特征检测,对识别到的二维码内容进行提取,二维码是设立在停泊点P两侧的两个Aruco二维码;
图片信息计算单元,用于从二维码内容中获得每个二维码的位姿及二维码内容像素的大小对比二维码的大小,分别获得无人船与两个二维码之间的位姿;
坐标系形成单元,用于根据两个二维码的位姿及两个二维码之间的距离,建立以双二维码位置为坐标的双二维码坐标系,计算在双二维码坐标系下无人船的摄像头位置(x,y)及无人船的船头朝向β。
9.如权利要求6所述的水面无人船自动停泊***,其特征在于:定位信息计算模块具体包括,
视觉定位误差曲线测量单元,用于测量视觉定位误差大小随z大小变化的曲线比例变化关系;
GPS定位误差计算单元,用于计算GPS定位的误差大小与GPS信号强度的变化关系;
置信度分数计算单元,用于计算对比视觉定位精度与GPS定位精度的误差大小,分别得到综合视觉定位与GPS定位的对比评价置信度分数;
融合定位策略设计单元,用于对比在同一时刻下视觉定位精度与GPS定位精度的置信度分数,设计双二维码视觉与GPS融合定位策略,以获得更高精度的无人船的定位信息。
10.如权利要求6所述的水面无人船自动停泊***,其特征在于:停泊控制模块具体包括,
停泊任务载入单元,用于在智能移动终端上软件载入标记的停泊点P的返航停泊任务,并开始返航停泊任务;
融合定位单元,用于在无人船到达第一停泊点P1时,同时开始视觉定位与GPS定位,同时依照双二维码视觉与GPS融合定位策略,实时、动态地计算出视觉定位结果与GPS定位结果之间置信度分数最高的融合定位结果;
停泊规划单元,用于根据实时动态的融合定位结果,计算并规划无人船最优的倒库停泊路线R,控制无人船沿着规划路线R行进停泊;
停泊验证单元,用于对无人船是否停泊至停泊点P进行自主验证,通过验证视觉定位结果、GPS定位结果以及是否卡位,综合自主验证是否到达目标停泊点P,完成自动停泊过程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111608638.XA CN114237262B (zh) | 2021-12-24 | 2021-12-24 | 一种水面无人船自动停泊方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111608638.XA CN114237262B (zh) | 2021-12-24 | 2021-12-24 | 一种水面无人船自动停泊方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114237262A true CN114237262A (zh) | 2022-03-25 |
CN114237262B CN114237262B (zh) | 2024-01-19 |
Family
ID=80763152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111608638.XA Active CN114237262B (zh) | 2021-12-24 | 2021-12-24 | 一种水面无人船自动停泊方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114237262B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117806328A (zh) * | 2023-12-28 | 2024-04-02 | 华中科技大学 | 一种基于基准标记的无人艇靠泊视觉引导控制方法及*** |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011117830A (ja) * | 2009-12-03 | 2011-06-16 | Toyota Motor Corp | Gnss受信装置及び測位方法 |
CN106647814A (zh) * | 2016-12-01 | 2017-05-10 | 华中科技大学 | 一种基于二维码地标识别的无人机视觉辅助定位与飞控***及方法 |
CN106683490A (zh) * | 2017-01-13 | 2017-05-17 | 江苏信息职业技术学院 | 基于图像处理的船舶停泊控制***及控制方法 |
CN106843198A (zh) * | 2015-12-07 | 2017-06-13 | 北京奇虎科技有限公司 | 扫地机器人自动返回充电方法、扫地机器人和充电座 |
CN206557605U (zh) * | 2017-03-16 | 2017-10-13 | 南京信息工程大学 | 一种无人船自动停泊*** |
CN107422730A (zh) * | 2017-06-09 | 2017-12-01 | 武汉市众向科技有限公司 | 基于视觉导引的agv运输***及其驾驶控制方法 |
CN109556616A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种基于视觉标记的自动建图机器人建图修整方法 |
CN110262507A (zh) * | 2019-07-04 | 2019-09-20 | 杭州蓝芯科技有限公司 | 一种基于5g通信的相机阵列机器人定位方法及装置 |
WO2019230620A1 (ja) * | 2018-05-29 | 2019-12-05 | ヤマハ発動機株式会社 | 船舶着岸支援装置および船舶着岸支援方法 |
CN110597252A (zh) * | 2019-09-03 | 2019-12-20 | 安徽江淮汽车集团股份有限公司 | 自动驾驶汽车融合定位控制方法、装置、设备及存储介质 |
CN110658826A (zh) * | 2019-10-22 | 2020-01-07 | 上海海事大学 | 一种基于视觉伺服的欠驱动无人水面艇自主靠泊方法 |
CN111462236A (zh) * | 2020-04-02 | 2020-07-28 | 集美大学 | 一种船舶间相对位姿检测方法及*** |
CN111679669A (zh) * | 2020-06-01 | 2020-09-18 | 陕西欧卡电子智能科技有限公司 | 一种无人船自主精准停靠方法及*** |
CN112509378A (zh) * | 2020-11-16 | 2021-03-16 | 安徽科微智能科技有限公司 | 一种无人船智能停泊***及其控制方法 |
CN113403942A (zh) * | 2021-07-07 | 2021-09-17 | 西北工业大学 | 一种基于标签辅助的桥梁检测无人机视觉导航方法 |
-
2021
- 2021-12-24 CN CN202111608638.XA patent/CN114237262B/zh active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011117830A (ja) * | 2009-12-03 | 2011-06-16 | Toyota Motor Corp | Gnss受信装置及び測位方法 |
CN106843198A (zh) * | 2015-12-07 | 2017-06-13 | 北京奇虎科技有限公司 | 扫地机器人自动返回充电方法、扫地机器人和充电座 |
CN106647814A (zh) * | 2016-12-01 | 2017-05-10 | 华中科技大学 | 一种基于二维码地标识别的无人机视觉辅助定位与飞控***及方法 |
CN106683490A (zh) * | 2017-01-13 | 2017-05-17 | 江苏信息职业技术学院 | 基于图像处理的船舶停泊控制***及控制方法 |
CN206557605U (zh) * | 2017-03-16 | 2017-10-13 | 南京信息工程大学 | 一种无人船自动停泊*** |
CN107422730A (zh) * | 2017-06-09 | 2017-12-01 | 武汉市众向科技有限公司 | 基于视觉导引的agv运输***及其驾驶控制方法 |
WO2019230620A1 (ja) * | 2018-05-29 | 2019-12-05 | ヤマハ発動機株式会社 | 船舶着岸支援装置および船舶着岸支援方法 |
CN109556616A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种基于视觉标记的自动建图机器人建图修整方法 |
CN110262507A (zh) * | 2019-07-04 | 2019-09-20 | 杭州蓝芯科技有限公司 | 一种基于5g通信的相机阵列机器人定位方法及装置 |
CN110597252A (zh) * | 2019-09-03 | 2019-12-20 | 安徽江淮汽车集团股份有限公司 | 自动驾驶汽车融合定位控制方法、装置、设备及存储介质 |
CN110658826A (zh) * | 2019-10-22 | 2020-01-07 | 上海海事大学 | 一种基于视觉伺服的欠驱动无人水面艇自主靠泊方法 |
CN111462236A (zh) * | 2020-04-02 | 2020-07-28 | 集美大学 | 一种船舶间相对位姿检测方法及*** |
CN111679669A (zh) * | 2020-06-01 | 2020-09-18 | 陕西欧卡电子智能科技有限公司 | 一种无人船自主精准停靠方法及*** |
CN112509378A (zh) * | 2020-11-16 | 2021-03-16 | 安徽科微智能科技有限公司 | 一种无人船智能停泊***及其控制方法 |
CN113403942A (zh) * | 2021-07-07 | 2021-09-17 | 西北工业大学 | 一种基于标签辅助的桥梁检测无人机视觉导航方法 |
Non-Patent Citations (4)
Title |
---|
MOHAMED: "Designing simple indoor navigation system for UVAss", MED 2011, pages 1223 * |
朱健楠,等: "无人水面艇感知技术发展综述", 哈尔滨工程大学学报, vol. 41, no. 10, pages 1486 - 1492 * |
袁荣健;: "基于无线传感器网络的船舶动力定位***的研究", 舰船科学技术, no. 12, pages 61 - 63 * |
郑又能: "面向无人船的计算机视觉应用研究", pages 24 - 71 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117806328A (zh) * | 2023-12-28 | 2024-04-02 | 华中科技大学 | 一种基于基准标记的无人艇靠泊视觉引导控制方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN114237262B (zh) | 2024-01-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107782321B (zh) | 一种基于视觉和高精度地图车道线约束的组合导航方法 | |
CN103065323B (zh) | 一种基于单应性变换矩阵的分段空间对准方法 | |
US7151996B2 (en) | System and method for generating a model of the path of a roadway from an image recorded by a camera | |
CN111598952B (zh) | 一种多尺度合作靶标设计与在线检测识别方法及*** | |
CN113657256B (zh) | 一种无人艇载无人机海空协同视觉跟踪与自主回收方法 | |
CN111968128A (zh) | 一种基于图像标记的无人机视觉姿态和位置解算方法 | |
CN112257539B (zh) | 车辆与车道线的位置关系检测方法、***和存储介质 | |
US20170316573A1 (en) | Position measuring equipment | |
CN111572633A (zh) | 转向角度检测方法、装置及*** | |
CN114237262B (zh) | 一种水面无人船自动停泊方法及*** | |
CN114821526A (zh) | 基于4d毫米波雷达点云的障碍物三维边框检测方法 | |
CN114413958A (zh) | 无人物流车的单目视觉测距测速方法 | |
Nomura et al. | Study of 3D measurement of ships using dense stereo vision: towards application in automatic berthing systems | |
CN112686149A (zh) | 一种基于视觉的固定翼无人机近地段自主着陆方法 | |
CN115239822A (zh) | 分体式飞行车辆多模块间实时视觉识别定位方法及*** | |
CN109459046B (zh) | 悬浮式水下自主航行器的定位和导航方法 | |
Krüger | Robust real-time ground plane motion compensation from a moving vehicle | |
Del Pizzo et al. | Reliable vessel attitude estimation by wide angle camera | |
Betge-Brezetz et al. | Object-based modelling and localization in natural environments | |
CN115792912A (zh) | 一种弱观测条件下基于视觉与毫米波雷达融合的水面无人艇环境感知方法及*** | |
CN112258391B (zh) | 一种基于道路交通标线的碎片化地图拼接方法 | |
CN115683128A (zh) | 一种港口无人集卡视觉特征匹配定位方法 | |
CN111854678B (zh) | 一种单目视觉下基于语义分割和卡尔曼滤波的位姿测量方法 | |
CN117360390A (zh) | 一种自适应车载毫米波雷达***及其控制方法 | |
CN113793315A (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 |