CN106871901B - 一种基于地形特征匹配的水下地形匹配导航方法 - Google Patents
一种基于地形特征匹配的水下地形匹配导航方法 Download PDFInfo
- Publication number
- CN106871901B CN106871901B CN201710062780.6A CN201710062780A CN106871901B CN 106871901 B CN106871901 B CN 106871901B CN 201710062780 A CN201710062780 A CN 201710062780A CN 106871901 B CN106871901 B CN 106871901B
- Authority
- CN
- China
- Prior art keywords
- gradient
- feature
- point
- matching
- terrain
- 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
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/04—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by terrestrial means
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manipulator (AREA)
Abstract
本发明提供一种基于地形特征匹配的水下地形匹配导航方法,处理先验地图,求出高度的梯度值,利用梯度的大小筛选出实际为较为陡峭的点作为特征点,将这些特征点的梯度进行霍夫变换得到特征的长度及位置,写入实际特征信息库。处理多波束声纳发回的数据,求出对应点的高度值,对其求梯度,将梯度的模长进行霍夫变换,得到样本特征的长度和与机器人的相对位置。利用这些特征的长度、对应深度等信息与之前构建的实际特征信息库进行匹配,得到与每一块特征区域所匹配的先验地图的区域。分别利用这些区域的相对位置信息得出水下机器人的位置,对这些位置进行分析得到机器人的精确位置。本发明可相对快速的地形匹配定位与导航任务。
Description
技术领域
本发明涉及一种定位与导航,尤其涉及一种基于地形特征匹配的水下地形匹配导航方法,属于水下定位与导航技术。
背景技术
水下机器人由于其成本低廉、可拓展性强、可以完成各种信息采集与利用等任务深受各国家研究机构重视,由于在水下环境中,高频信号衰减快,所以GPS等常规定位方式并不适用,由于定位与导航是水下机器人能否安全返航的重要技术因素,所以找到可行的定位与导航技术成为了水下机器人领域的重点技术。
现阶段水下机器人导航技术主要有惯性导航、水声学导航、航位推算导航以及地形匹配导航。惯性导航与航位推算导航由于精度有限以及需要定期上浮利用GPS修正等因素受到限制,不利于水下机器人长期水下作业,而水声学导航需要声学基阵,实际操作过程需要辅助才能完成。
发明内容
本发明的目的是为了提供一种基于地形特征匹配的水下地形匹配导航方法。
本发明的目的是这样实现的:第一步:处理已知的先验地图,计算先验地图中的每一点的高度的梯度通过对高度的梯度grad(x,y)的大小进行筛选,选出梯度的模长||grad(x,y)||>阈值Α的点作为先验地图的特征点;
第二步:将第一步得到的所有先验地图的特征点的梯度的模长||grad(x,y)||做霍夫变换,识别出每一个特征的拟合线段,并记录这些线段的起始点坐标位置(xs,ys),(xe,ye)以及每条线段对应的高度作为实际特征信息存入实际特征信息库;
第三步:启动多波束声纳,采集水下机器人所在位置及周边的实时水深数据,记录得到的每一个数据点的坐标位置(x*,y*)以及对应数据点的深度h*;
第四步:计算第三步中的每一个数据点水深的梯度通过对水深的梯度grad(x*,y*)的大小进行筛选,选出梯度的模长||grad(x*,y*)||>Α的点作为多波束声纳数据的特征点;
第五步:将第四步得到的多波束声纳数据的特征点的梯度的模长||grad(x,y)||做霍夫变换,并识别出每一个特征的拟合线段,记录这些线段的起始点坐标位置(xs,ys),(xe,ye)以及每条线段对应的高度信息、与机器人的相对位置信息,作为样本特征信息;
第六步:逐条读取样本特征信息,判断实际特征信息库中是否存在高度相匹配的特征:若存在则进行下一步,若不存在,则读取下一条特征,重复此步骤;
第七步:判断经第六步得到的特征中是否存在长度相一致的特征,若存在则进行下一步,若不存在,则读取下一条特征,重复第六步;
第八步:读取第七步得到的相匹配的特征的端点坐标位置(x* s,y* s),(x* e,y* e),找到能将样本特征端点坐标(xs,ys),(xe,ye)转换为匹配特征端点(x* s,y* s),(x* e,y* e)的坐标变换;
第九步:根据第八步中的坐标变换以及第五步中与机器人的相对位置信息得到机器人此时的位置(x1,y1),(x2,y2)…(xn,yn);
第十步:根据第九步得到的位置,得到最终确定的精确坐标位置
第十一步:将(xmatch,ymatch)反馈给主控计算机,完成地形匹配定位。
与现有技术相比,本发明的有益效果是:本发明使用梯度进行判断,可克服涨落潮差等因素影响,由于只对筛选出的特征进行匹配,很大程度上减小了匹配过程的计算量。
本发明通过提取探测到地形的特征(实际为较为陡峭的点)信息来与已知地形进行快速匹配,在不依赖于GPS、初始位置等信息的情况下进行相对快速的地形匹配定位与导航任务。
附图说明
图1为本发明的流程图;
图2为本发明提取特征点的流程图;
图3为本发明匹配操作的流程图。
具体实施方式
下面结合附图与具体实施方式对本发明作进一步详细描述。
本发明涉及的是一种基于地形梯度特征匹配的水下地形匹配方法,包括已知的地形的处理来提取特征点和通过处理探测到的地形得到特征点并与上一步得到的已知特征点进行匹配来确定自身位置。
结合图1说明整体的实现方式,本发明处理先验地图数据,提取特征点,将特征点的梯度进行霍夫变换,得到特征的长度、端点位置,将这些信息存储为实际特征点信息库,用作后续匹配。将多波束声纳传回的数据进行处理,也应用算法提取出特征,将这些特征信息进行整合,得到样本特征信息。将样本特征信息与之前生成的实际特征点信息库进行匹配,得到对应的位置信息,进行处理得到此时机器人的精确位置坐标。
结合图2说明提取特征的过程,首先将先验地图高度数据/探测到的高度数据进行处理,由下式计算出高度的梯度grad(x,y)/grad(x*,y*)。
在此过程后判断高度的梯度大小是否大于阈值A即判断||grad(x,y)||>Α,若||grad(x,y)||≤Α则认为此点不是特征点,若||grad(x,y)||>Α,则认为此点是特征点,记录这个点的梯度等信息。
判断是否数据读取完毕,若读取完毕则进行下一步,否则读取下一点数据重复上述步骤。
将所有的特征点的梯度的模长||grad(x,y)||进行霍夫变换,得到各个特征所对应的线段,记录线段的端点(xs,ys),(xe,ye),以及每一条线段所对应位置的高度,得到实际特征信息存入实际特征点信息库/样本特征点信息。
结合图3说明匹配操作的实现方式,逐条读取样本特征信息,判断实际特征信息中是否存在高度相匹配的特征,若不存在则读取下一条数据重新判断;若存在则判断这些特征中是否存在长度相一致的特征,若相同则认为找到相匹配的特征点,读取端点坐标(x* s,y* s),(x* e,y* e)进行下一步操作,若不存在,则读取下一条数据重新重复上述步骤。找到能将样本特征端点坐标(xs,ys),(xe,ye)转换为匹配特征端点(x* s,y* s),(x* e,y* e)的旋转变换,据此得到机器人此时的位置(xmatch,ymatch)。
本发明的具体流程如下:
1、处理先验地图,计算每一点的高度的梯度通过对高度的梯度grad(x,y)的大小进行筛选,选出梯度的模长||grad(x,y)||>阈值Α的点作为特征点。
2、将这些特征点的梯度的模长||grad(x,y)||做霍夫变换,识别出每一个特征的拟合线段,也即得到各个特征所对应的线段,记录这些线段的起始点坐标(xs,ys),(xe,ye),以及每条线段对应的高度信息,作为实际特征信息存入实际特征点信息库。
3、启动多波束声纳,采集水下机器人所在位置及周边的实时水深数据,记录得到的每一个数据点的位置(x*,y*),以及对应点的深度h*。
4、计算每一个测量点水深的梯度通过对水深的梯度grad(x*,y*)的大小进行筛选,选出梯度的模长||grad(x*,y*)||>Α的点作为特征点。
5、将这些特征点的梯度的模长||grad(x,y)||做霍夫变换,识别出每一个特征的拟合线段,记录这些线段的起始点坐标(xs,ys),(xe,ye),以及每条线段对应的高度信息、与机器人的相对位置信息,作为样本特征信息。
6、通过对比特征的大小及对应高度,在实际特征点信息库中筛选出与之相匹配的特征,找到两者的空间位置关系,也即逐条读取样本特征信息,判断实际特征信息中是否存在高度相匹配的特征,若存在则进行下一步,若不存在,则读取下一条特征,重复此步骤。
7、判断这些特征中是否存在长度相一致的特征,若存在则进行下一步,若不存在,则读取下一条特征,重复步骤(6)。
8、此时认为找到相匹配的特征,读取端点坐标(x* s,y* s),(x* e,y* e),找到能将样本特征端点坐标(xs,ys),(xe,ye)转换为匹配特征端点(x* s,y* s),(x* e,y* e)的旋转变换。
9、根据步骤(8)中的坐标变换,以及步骤(5)中特征与机器人的相对位置信息,也即根据样本特征与实际特征的空间关系以及样本特征与机器人的相对位置信息得到机器人此时的位置(x1,y1),(x2,y2)…(xn,yn)。
10、处理这些定位位置,得到最终确定的精确定位点
11、将(xmatch,ymatch)反馈给主控计算机,完成地形匹配定位。
具体的说本发明的提取给定区域的特征包括:
(1)计算每一点的高度的梯度
(2)判断每一点高度的梯度的模长||grad(x,y)||是否大于给定的值阈值A;
(3)若梯度的模长小于等于阈值A,即||grad(x,y)||≤Α,则此点不是特征点;
(4)若梯度的模长大于阈值A,即||grad(x,y)||>Α,则此点视为特征点;
(5)将所有的特征点的梯度的模长||grad(x,y)||进行霍夫变换,得到各个特征所对应的线段;
(6)记录线段的端点(xs,ys),(xe,ye),以及每一条线段所对应位置的高度,作为实际特征信息存入实际特征点信息库/样本特征点信息用来匹配。
Claims (1)
1.一种基于地形特征匹配的水下地形匹配导航方法,其特征在于:包括如下步骤:
第一步:处理已知的先验地图,计算先验地图中的每一点的高度的梯度通过对高度的梯度grad(x,y)的大小进行筛选,选出梯度的模长||grad(x,y)||>阈值Α的点作为先验地图的特征点;
第二步:将第一步得到的所有先验地图的特征点的梯度的模长||grad(x,y)||做霍夫变换,识别出每一个特征的拟合线段,并记录这些线段的起始点坐标位置(xs,ys),(xe,ye)以及每条线段对应的高度作为实际特征信息存入实际特征信息库;
第三步:启动多波束声纳,采集水下机器人所在位置及周边的实时水深数据,记录得到的每一个数据点的坐标位置(x*,y*)以及对应数据点的深度h*;
第四步:计算第三步中的每一个数据点水深的梯度通过对水深的梯度grad(x*,y*)的大小进行筛选,选出梯度的模长||grad(x*,y*)||>Α的点作为多波束声纳数据的特征点;
第五步:将第四步得到的多波束声纳数据的特征点的梯度的模长||grad(x,y)||做霍夫变换,并识别出每一个特征的拟合线段,记录这些线段的起始点坐标位置(xs,ys),(xe,ye)以及每条线段对应的高度信息、与机器人的相对位置信息,作为样本特征信息;
第六步:逐条读取样本特征信息,判断实际特征信息库中是否存在高度相匹配的特征:若存在则进行下一步,若不存在,则读取下一条特征,重复此步骤;
第七步:判断经第六步得到的特征中是否存在长度相一致的特征,若存在则进行下一步,若不存在,则读取下一条特征,重复第六步;
第八步:读取第七步得到的相匹配的特征的端点坐标位置找到能将样本特征端点坐标(xs,ys),(xe,ye)转换为匹配特征端点的坐标变换;
第九步:根据第八步中的坐标变换以及第五步中与机器人的相对位置信息得到机器人此时的位置(x1,y1),(x2,y2)…(xn,yn);
第十步:根据第九步得到的位置,得到最终确定的精确坐标位置
第十一步:将(xmatch,ymatch)反馈给主控计算机,完成地形匹配定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710062780.6A CN106871901B (zh) | 2017-01-24 | 2017-01-24 | 一种基于地形特征匹配的水下地形匹配导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710062780.6A CN106871901B (zh) | 2017-01-24 | 2017-01-24 | 一种基于地形特征匹配的水下地形匹配导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106871901A CN106871901A (zh) | 2017-06-20 |
CN106871901B true CN106871901B (zh) | 2019-11-08 |
Family
ID=59165650
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710062780.6A Active CN106871901B (zh) | 2017-01-24 | 2017-01-24 | 一种基于地形特征匹配的水下地形匹配导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106871901B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110906928A (zh) * | 2019-11-22 | 2020-03-24 | 哈尔滨工程大学 | 基于地形梯度拟合的粒子滤波水下航迹跟踪方法 |
CN112729306B (zh) * | 2020-12-21 | 2022-04-19 | 哈尔滨工程大学 | 适用于auv的海底地形图可导航区自主提取方法 |
CN112762924B (zh) * | 2020-12-23 | 2023-07-14 | 北京机电工程研究所 | 基于重力梯度-地形异源数据匹配的导航定位方法 |
CN112902948A (zh) * | 2021-01-18 | 2021-06-04 | 国家深海基地管理中心 | 一种深海地形地貌联合匹配辅助导航定位系统及方法 |
CN114563019B (zh) * | 2022-03-16 | 2023-10-31 | 浙江省水利河口研究院(浙江省海洋规划设计研究院) | 单波束时延检校方法 |
CN117333688B (zh) * | 2023-12-01 | 2024-03-15 | 西安现代控制技术研究所 | 一种基于多维梯度特征的高精度地形匹配方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103047984A (zh) * | 2013-01-14 | 2013-04-17 | 哈尔滨工程大学 | 水下机器人的线地形匹配导航方法 |
CN103047983A (zh) * | 2013-01-14 | 2013-04-17 | 哈尔滨工程大学 | 水下机器人的面地形匹配导航方法 |
-
2017
- 2017-01-24 CN CN201710062780.6A patent/CN106871901B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103047984A (zh) * | 2013-01-14 | 2013-04-17 | 哈尔滨工程大学 | 水下机器人的线地形匹配导航方法 |
CN103047983A (zh) * | 2013-01-14 | 2013-04-17 | 哈尔滨工程大学 | 水下机器人的面地形匹配导航方法 |
Non-Patent Citations (1)
Title |
---|
AUB搭载多波束声呐进行地形测量的现状及展望;李岳明等;《海洋测绘》;20160731;第36卷(第4期);第7-11页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106871901A (zh) | 2017-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106871901B (zh) | 一种基于地形特征匹配的水下地形匹配导航方法 | |
KR101781757B1 (ko) | 객체 인식을 위한 수중 이미지 처리장치 및 그 방법 | |
CN102426019B (zh) | 一种无人机景象匹配辅助导航方法及系统 | |
CN112229404B (zh) | 基于海底地形三维优化原理提高海洋重力场插值精度方法 | |
US20060195858A1 (en) | Video object recognition device and recognition method, video annotation giving device and giving method, and program | |
EP1622081A1 (en) | Video object recognition device and recognition method, video annotation giving device and giving method, and program | |
CN110751077B (zh) | 一种基于部件匹配与距离约束的光学遥感图片船舶检测方法 | |
CN108344999A (zh) | 一种用于水下机器人导航的声呐地图构建与重定位方法 | |
CN116385810B (zh) | 一种基于YOLOv7的小目标检测方法及系统 | |
JP4946072B2 (ja) | 樹頂探索方法、装置及びプログラム | |
WO2018131546A1 (ja) | 情報処理装置、情報処理システム、情報処理方法、および情報処理プログラム | |
Praczyk et al. | Concept and first results of optical navigational system | |
JP4570995B2 (ja) | マッチング方法およびマッチング装置ならびにプログラム | |
CN108090898B (zh) | 基于字典表示的卫星遥感图像典型地标检测方法 | |
CN104123724B (zh) | 一种3d点云物体的快速检测方法 | |
CN113532438A (zh) | 一种大初始定位误差下的改进iccp地形匹配方法 | |
CN106897683B (zh) | 一种遥感图像的地物检测方法及系统 | |
CN106770007B (zh) | 一种支持向量机模型的近红外光谱特征波长选择方法 | |
Song et al. | Underwater terrain-aided navigation based on multibeam bathymetric sonar images | |
CN104077592B (zh) | 高分辨率遥感影像航标自动提取方法 | |
CN115565072A (zh) | 一种道路垃圾识别和定位方法、装置、电子设备及介质 | |
Ren et al. | Underwater visual tracking method based on kcf algorithm of aruco marker | |
CN114463628A (zh) | 一种基于阈值约束的深度学习遥感影像船舰目标识别方法 | |
CN109816713B (zh) | 一种非自主测绘海图的水深注记精度定量评估方法 | |
CN114092423A (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 |