CN106767749A - 一种基于grd格式地图的路径生成方法 - Google Patents
一种基于grd格式地图的路径生成方法 Download PDFInfo
- Publication number
- CN106767749A CN106767749A CN201510822664.0A CN201510822664A CN106767749A CN 106767749 A CN106767749 A CN 106767749A CN 201510822664 A CN201510822664 A CN 201510822664A CN 106767749 A CN106767749 A CN 106767749A
- Authority
- CN
- China
- Prior art keywords
- point
- grd
- cartographic information
- method based
- coordinates
- 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
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及水下机器人技术领域,尤其涉及一种基于GRD格式地图的路径生成方法,实现自主水下机器人在变化海洋环境下的路径规划。包括以下步骤:读取GRD格式的地图文件获得地图信息;将获得的地图信息载入到地图转化软件中,根据地图信息,进行地图信息识别;根据潜水器的起始点,规划出下一个航行点的坐标,通常下一个航行点使用的是极坐标,将极坐标转换成大地坐标系。与简单的路径规划方法比较,本方法具有更好的性能,在热液探测环境下更有优势,更能适应外界环境的改变,提高了AUV的工作能力。本方法移植方便,可以适用于各种水下机器人。
Description
技术领域
本发明涉及水下机器人技术领域,尤其涉及一种基于GRD格式地图的路径生成方法。
背景技术
在海洋应用中,水下机器人发挥越来越重要的作用。水下机器人分成两类:一种是遥控式有缆水下机器人(简称ROV),一种是自主水下机器人(简称AUV)。ROV需要水面母船支持,同时受到电缆长度的限制,其作业距离有限,一般只有几百米;而AUV自身携带能源,可以远离母船,活动距离达到几十公里甚至上百公里。所以AUV的研究越来越受到各国的重视,AUV的发展代表了未来水下机器人的发展方向。但是AUV的控制方法比ROV的控制方法复杂,只有设计出好的控制方法才能发挥出AUV强大的作业能力。
AUV执行地形勘查、管线跟踪都依赖于AUV的路径规划。通常在AUV工作前,获取当前海区的地图,然后根据地图进行规划,当地形起伏不是很大时,可以使用简单的定高模式和定深模式航行,但是对于复杂海区的情况下,这种方式规划出来的路径不能很好的实现任务需求,如果分段规划则费时费力,对于操作AUV的人员是一个很大的挑战,这种简单的方法不适用在复杂的环境下。
发明内容
针对现有技术中存在的上述不足之处,本发明要解决的技术问题是提供一种基于GRD格式地图的路径生成方法,使规划路径的过程更简单,AUV执行的使命更加满足任务需求。
本发明为实现上述目的所采用的技术方案是:一种基于GRD格式地图的路径生成方法,包括以下步骤:
读取GRD格式的地图文件获得地图信息;
根据所述地图信息,进行地图信息识别;
将获得的地图信息载入到地图转化软件中;
根据潜水器的起始点,规划出下一个航行点的坐标,将航行点的极坐标转换成大地坐标系。
所述地形信息包括经度、纬度、深度/高度。
所述地图信息识别,包括以下步骤:
根据选择的目标深度,获得等深线,同时根据选择的预定的起始点,按照正东、正南、正西、正北、东南、东北、西南和西北八个方向生成射线,计算各个方向上射线的梯度;
根据射线的梯度,选择绝对值最小的一个点作为下一航行点;
按照上述方法持续计算下一航行点,直到满足探测当前深度或者覆盖该地图的任务需求。
所述射线的梯度通过下式计算:
若函数t=f(x,y,z)在点(x0,y0,z0)处可微,则函数F(x)在点(x0,y0,z0)处沿任一方向的方向倒数存在,其中各倒数均为在点(x0,y0,z0)处的值,运用向量的数量积,可将方向导数计算公式表示为:
其中,
gradt称为梯度。
所述将得到的航行点的极坐标转换成大地坐标系,具体为:
下一个航行点的经纬度坐标(a1,b1)为:
其中,(a,b)为起始点的经纬度坐标,a为经度,b为纬度,ρ为起始点到航行点的距离,θ为起始点到航行点的连线与正北方向的夹角;
根据公式(2)和(3),类推获得所有航行点的经纬度坐标。
本发明具有以下优点及有益效果:
1.对于潜水器的模型不敏感,完全可以适用任何潜水器。
2.对于其它格式的地图也可以按照此方法进行扩展,只是在读取格式的时候进行不同的解码。
附图说明
图1为软件界面显示的地图;
图2为本发明方法流程图。
具体实施方式
下面结合附图及实施例对本发明做进一步的详细说明。
本发明的硬件要求是一台电脑,装载可以读取GRD格式的文件的程序,使用利用本方法编译的程序,将获得的地理信息显示出来,同时选择起始点,选择路径长度,生成规划。
本发明通过读取GRD格式的地图文件获得地形信息:经度、纬度、深度/高度,通过提取同一深度或者同一高度的坐标点,自动生成同一深度/高度的路径,同时覆盖当前海区。使用软件查看地图,同时将地图保存成需要的GRD格式,将获得的地图信息载入到地图转化软件中。
如图2所示,首先初始化某一程序,将获得的GRD格式的地图载入该程序,这时软件界面上显示类似图1所示的地图,此时根据该界面,可以知道当前海图内的深度/高度信息,选择入水点和制定梯度的规则,生成路径,如果某一路径不满足任务需求,可以手工修改,若都满足当前的任务需求,则保存路径。
本发明的中的自动生成路径的方法包含地图信息识别和坐标转换方法,以下详细描述这两方面内容:
本发明中的地图信息识别是指根据已有的地图信息,根据选择的目标深度,获得等深线,同时根据选择的预定的起始点,按照正东,正南,正西,正北,东南,东北,西南,西北八个方向生成射线,根据射线的梯度,计算下一个航行点。
若函数t=f(x,y,z)在点(x0,y0,z0)处可微,则函数F(x)在点(x0,y0,z0)处沿任一方向的方向倒数存在,其中各倒数均为在点(x0,y0,z0)处的值,运用向量的数量积,可将方向导数计算公式表示为:
其中,
gradt称为梯度。
本发明中的坐标转换方法,是将极坐标转换成大地坐标系。
已知起始点坐标(a,b),a为经度,b为纬度;下一个航行点坐标为(ρ,θ)。ρ为起始点到航行点的距离,θ为起始点到航行点的连线与正北方向的夹角。
设航行点经纬度坐标为(a1,b1)
根据公式(2)、(3),以此类推获得所有的航行点。此时航行点的目标深度值为起始点的目标深度。
Claims (5)
1.一种基于GRD格式地图的路径生成方法,其特征在于,包括以下步骤:
读取GRD格式的地图文件获得地图信息;
根据所述地图信息,进行地图信息识别;
将获得的地图信息载入到地图转化软件中;
根据潜水器的起始点,规划出下一个航行点的坐标,将航行点的极坐标转换成大地坐标系。
2.根据权利要求1所述的一种基于GRD格式地图的路径生成方法,其特征在于,所述地形信息包括经度、纬度、深度/高度。
3.根据权利要求1所述的一种基于GRD格式地图的路径生成方法,其特征在于,所述地图信息识别,包括以下步骤:
根据选择的目标深度,获得等深线,同时根据选择的预定的起始点,按照正东、正南、正西、正北、东南、东北、西南和西北八个方向生成射线,计算各个方向上射线的梯度;
根据射线的梯度,选择绝对值最小的一个点作为下一航行点;
按照上述方法持续计算下一航行点,直到满足探测当前深度或者覆盖该地图的任务需求。
4.根据权利要求3所述的一种基于GRD格式地图的路径生成方法,其特征在于,所述射线的梯度通过下式计算:
若函数t=f(x,y,z)在点(x0,y0,z0)处可微,则函数F(x)在点(x0,y0,z0)处沿任一方向的方向倒数存在,其中各倒数均为在点(x0,y0,z0)处的值,运用向量的数量积,可将方向导数计算公式表示为:
其中,
gradt称为梯度。
5.根据权利要求1所述的一种基于GRD格式地图的路径生成方法,其特征在于,所述将得到的航行点的极坐标转换成大地坐标系,具体为:
下一个航行点的经纬度坐标(a1,b1)为:
其中,(a,b)为起始点的经纬度坐标,a为经度,b为纬度,ρ为起始点到航行点的距离,θ为起始点到航行点的连线与正北方向的夹角;
根据公式(2)和(3),类推获得所有航行点的经纬度坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510822664.0A CN106767749B (zh) | 2015-11-20 | 2015-11-20 | 一种基于grd格式地图的路径生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510822664.0A CN106767749B (zh) | 2015-11-20 | 2015-11-20 | 一种基于grd格式地图的路径生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106767749A true CN106767749A (zh) | 2017-05-31 |
CN106767749B CN106767749B (zh) | 2019-01-25 |
Family
ID=58964546
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510822664.0A Active CN106767749B (zh) | 2015-11-20 | 2015-11-20 | 一种基于grd格式地图的路径生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106767749B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107816999A (zh) * | 2017-09-25 | 2018-03-20 | 华南理工大学 | 一种基于蚁群算法的无人船航行路径自主规划方法 |
CN108007470A (zh) * | 2017-11-30 | 2018-05-08 | 深圳市隐湖科技有限公司 | 一种移动机器人地图文件格式和路径规划系统及其方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103077425A (zh) * | 2012-11-23 | 2013-05-01 | 中国科学院沈阳自动化研究所 | 一种用于auv实时路径规划的免疫遗传算法 |
CN103968841A (zh) * | 2014-06-03 | 2014-08-06 | 哈尔滨工程大学 | 一种基于改进萤火虫算法的auv三维航路规划方法 |
-
2015
- 2015-11-20 CN CN201510822664.0A patent/CN106767749B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103077425A (zh) * | 2012-11-23 | 2013-05-01 | 中国科学院沈阳自动化研究所 | 一种用于auv实时路径规划的免疫遗传算法 |
CN103968841A (zh) * | 2014-06-03 | 2014-08-06 | 哈尔滨工程大学 | 一种基于改进萤火虫算法的auv三维航路规划方法 |
Non-Patent Citations (3)
Title |
---|
余翀: "基于栅格地图的分层式机器人路径规划算法", 《中国科学院大学学报》 * |
孙俊岭: "基于电子海图的智能潜水器路径规划研究", 《海洋工程》 * |
申雄: "一种欠定位水下机器人的目标搜索研究", 《中国机械工程》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107816999A (zh) * | 2017-09-25 | 2018-03-20 | 华南理工大学 | 一种基于蚁群算法的无人船航行路径自主规划方法 |
CN108007470A (zh) * | 2017-11-30 | 2018-05-08 | 深圳市隐湖科技有限公司 | 一种移动机器人地图文件格式和路径规划系统及其方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106767749B (zh) | 2019-01-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104075715B (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
JP2018155765A (ja) | 自立型水中航行機の地図作成探査のための磁気データの補償 | |
Smith et al. | Controlling buoyancy-driven profiling floats for applications in ocean observation | |
CN102541062B (zh) | 一种水下自主式航行器的局部路径规划方法 | |
CN106679662B (zh) | 一种基于tma技术的水下机器人单信标组合导航方法 | |
CN102445201A (zh) | 用于水下载体的地磁异常特征点匹配导航方法 | |
CN104655131A (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN103940446A (zh) | 一种基于横坐标系的极区航行船舶捷联惯性导航系统重调方法 | |
Liu et al. | A practical path planning and navigation algorithm for an unmanned surface vehicle using the fast marching algorithm | |
CN109425347A (zh) | 一种半潜无人船的同时定位与地图构建方法 | |
CN103940429A (zh) | 一种惯性导航系统横坐标系下载体姿态的实时测量方法 | |
Gerovasileiou et al. | Three-dimensional mapping of marine caves using a handheld echosounder | |
McFarland et al. | Toward ice-relative navigation of underwater robotic vehicles under moving sea ice: Experimental evaluation in the arctic sea | |
CN111412918B (zh) | 无人艇全局安全路径规划方法 | |
CN103292813B (zh) | 一种提高水面艇编队导航精度的信息滤波方法 | |
CN112880678A (zh) | 一种复杂水域环境中无人艇航行规划方法 | |
CN106767749A (zh) | 一种基于grd格式地图的路径生成方法 | |
Vasilijevic et al. | An ASV for coastal underwater archaeology: The Pladypos survey of Caesarea Maritima, Israel | |
KR101738239B1 (ko) | 구글맵과 enc를 이용한 3차원 항해환경 구현 방법 | |
CN106556828A (zh) | 一种基于凸优化的高精度定位方法 | |
CN104680583B (zh) | 一种海底地形自动生成的方法 | |
Wang et al. | Terrain matching localization for hybrid underwater vehicle in the Challenger Deep of the Mariana Trench | |
CN107990896A (zh) | 一种基于xyz格式地图的路径生成方法 | |
Dong et al. | A new navigation strategy for underwater robot in reactor pool combined propeller speed detection and dynamics analysis with sonar data correction | |
CN107462865A (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 |