CN108981716B - 一种适用于内陆和近海无人船的路径规划方法 - Google Patents
一种适用于内陆和近海无人船的路径规划方法 Download PDFInfo
- Publication number
- CN108981716B CN108981716B CN201810959463.9A CN201810959463A CN108981716B CN 108981716 B CN108981716 B CN 108981716B CN 201810959463 A CN201810959463 A CN 201810959463A CN 108981716 B CN108981716 B CN 108981716B
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- point
- ship
- unmanned
- target point
- 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
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000008569 process Effects 0.000 claims abstract description 14
- 238000013459 approach Methods 0.000 claims abstract description 10
- 238000012545 processing Methods 0.000 claims abstract description 7
- 238000009499 grossing Methods 0.000 claims abstract description 6
- 230000005484 gravity Effects 0.000 claims description 28
- 230000004888 barrier function Effects 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 5
- 230000009471 action Effects 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 3
- 230000008676 import Effects 0.000 claims 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 abstract description 20
- 238000010845 search algorithm Methods 0.000 description 5
- 230000007547 defect Effects 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 238000013507 mapping Methods 0.000 description 4
- 241000282414 Homo sapiens Species 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000005070 sampling Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000009191 jumping Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000003912 environmental pollution Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000002352 surface water Substances 0.000 description 1
Images
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
- G01C21/203—Specially adapted for sailing ships
-
- 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)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种适用于内陆和近海无人船的路径规划方法。对于已知的地图环境,将环境地图进行锐化处理后输入无人船核心处理器;无人船核心处理器接收环境地图图像信息,并对其进行再次处理,转化为无人船核心处理器能够识别的环境地图电子数据信息;针对环境地图电子数据信息,综合考虑无人船起点,途径点,终点,用经改进的快速拓展随机树RRT算法介入进行运算,得出整体基本规划路线;船载核心处理器对整体基本规划路线进行B样条曲线圆滑处理,进一步优化路线;将路径规划路线图传送给无人船船体控制系统,再由无人船船体控制系统对船体进行控制,使其沿优化后的路线进行航行。本发明提高了无人船在水面路径规划方面的安全性和效率。
Description
技术领域
本发明属于无人船自主决策装置,涉及无人船技术,路径规划算法领域,具体为一种适用于内陆和近海无人船的路径规划方法。
背景技术
伴随世界人口快速增长,社会高速发展和人类活动日益频繁,过多追求经济效益导致环境污染日趋加深,这其中水资源的污染尤为严重。为保障人类社会能够继续高速可持续化发展,近海和内陆地表水体的测绘和监测成为不可或缺的重要工作。根据我国环保部现行规定,不同等级水库需按时定点采集水样作水质分析,以保障居民生活用水;根据我国水利资源部的现行规定,针对我国内湖内河需定时进行水文信息采集,以便监测收集水体信息供绘制地图和水利资源管理。而人工测量采集费时费力,人力物力成本较高,且在一定区域,载人船只由于重量较大,吃水较深,无法航行至待测水面的全部区域,所以在当下各个行业都以无人设备代替人工的大趋势下,无人船成为了取代人工进行水文勘探测绘和水质采样工作的优质选择。无人船是继无人机和无人车之后无人设备的又一大新研究领域,是一种现代无人技术与多领域技术相结合的产物,具有一定的自主规划、自主航行、自主调节能力。无人船在工作过程中可以根据卫星地图以及实际的工作环境中所感知的信息,相对于传统船只具有明显优势。而目前,无人机、无人车已经成功在摄影、快递分拣、玩具、家居、港口集装箱运输、消防、反恐打击、国防军事等等行业成熟应用并且实现了商业化,相比之下对于无人船领域的研究起步较晚,但发展前景良好,潜在发展空间巨大。而在水文测绘和水质监测此类领域中更是少有类似自主航行无人船的应用,其路径规划方法也多用于其他领域,在无人船领域少有应用,所以本发明提出一种适用于此类情形下的无人船及其路径规划方法。
现有公开技术:
专利申请号CN 107816999A的专利《一种基于蚁群算法的无人船航行路径自主》中介绍了一种基于蚁群算法的无人船航行路径自主规划方法;
专利申请号CN 106774341A的专利《无人船运动控制系统及运动控制方法》中发布了一种涉及无人船运动控制系统及控制方法;
现有技术在进行水文测绘和水质采集时往往耗时费力,效率低下,占用大量人工成本的同时且路线规划结果很差。而且,载人船只重量大,吃水深,船体尺寸大,在小型水域不够灵活;噪音大,严重影响自然生态文明建设。而现有少量算法在无人船领域的应用不够完善,得出的规划路线不够精确圆滑,且运算耗时过长,导致整体规划效果往往很差、效率不高。
为减少人力资源占用,降低经济成本,覆盖率更高地测量水文水体信息,考虑采取无人船代替人工进行水文测绘和定时定点水质采样工作。无人船尺寸小巧,重量轻便,吃水较浅。使用无人船进行水文勘探和水质采样工作,可以到达的水面区域更广,水面覆盖率更高。另外,为克服现有无人船路径规划算法不足,综合算法快速性和精确性,提出一种基于快速拓展随机树的启发式搜索算法,以改善原有算法速度慢、效果差、效率低等缺点。
发明内容
本发明的目的在于提供一种适用于内陆和近海无人船的路径规划方法,该路径规划方法以传统快速拓展随机树算法(RRT)为主要基础,再辅以人工设定势场函数拓展和目标引力函数扩展相结合的扩展策略,并采用节点拓展概率准则及多步贪婪准则,自动求解出无人船的航行路径;大大改善了单一传统快速拓展随机树随机性太高,求解不稳定,容易陷入局部最优解的缺点。
为实现上述目的,本发明的技术方案是:一种适用于内陆和近海无人船的路径规划方法,包括如下步骤:
步骤S1、对于已知的地图环境,将环境地图进行锐化处理后输入无人船核心处理器;
步骤S2、无人船核心处理器接收环境地图图像信息,并对其进行再次处理,转化为无人船核心处理器能够识别的环境地图电子数据信息;
步骤S3、针对环境地图电子数据信息,综合考虑无人船起点,途径点,终点,用经改进的快速拓展随机树RRT算法介入进行运算,得出整体基本规划路线;
步骤S4、船载核心处理器对步骤S3得出的整体基本规划路线进行B样条曲线圆滑处理,进一步优化路线;
步骤S5、将路径规划路线图传送给无人船船体控制系统,再由无人船船体控制系统对船体进行控制,使其沿步骤S4优化后的路线进行航行。
在本发明一实施例中,所述步骤S1具体实现如下:
首先确定一个包含环境地图信息和船体运动状态模型的坐标系;将环境地图进行锐化,空白部分为可行驶区域,阴影部分为障碍物,环境地图信息就可以以横纵坐标系表示,无人船核心处理器就能够读取和识别地图信息;
包含的非完整性约束可由微分方程X=f(x,u)表示,状态转移方程:
在本发明一实施例中,所述步骤S2具体实现为:通过船上传感器来感知附近环境信息,结合无人船核心处理器已经获取的环境地图信息,将整个环境地图空间划分为障碍物空间Xobs和无障碍物空间Xfree,障碍物以阴影部分来表示。
在本发明一实施例中,所述步骤S3,针对环境地图电子数据信息,利用无人船核心处理器,导入快速拓展随机树RRT算法对其进行路径规划的计算;针对无人船当时的工作场景和所要执行的具体任务,综合考虑到无人船的起始位置,起始状态,路径中所要途径的点以及终点,导入改进后的快速拓展随机树RRT算法进行运算;运算的过程又分为如下步骤:
步骤S31、无人船核心处理器接收环境地图电子数据信息,确定起始点状态和目标点状态;
步骤S32、通过改进后的快速拓展随机树RRT算法进行快速拓展随机树路线拓展;
步骤S33、若遇到障碍物,则提升人工势场函数权重,使无人船避开障碍物;
步骤S34、若距离目标点越来越远,则提升目标引力函数,使无人船向着靠近目标点的方向前进;若无人船距离目标点越来越近,则执行下一步骤;
步骤S35、若算法陷入局部最优点,则说明目标引力函数所占权重过高,此时则需要提升RRT算法权重以便能够跳出局部最优点,继续寻找目标点;若算法没有陷入局部最优点,则执行下一步骤;
步骤S36、判断是否已经到达目标点位置状态,若没有到达目标点位置状态,则降低RRT算法权重,回到步骤S32,继续进行拓展;
步骤S37、若已到达目标点位置状态,则对规划路线进行B样条曲线处理,继续优化路线;
步骤S38、得到最终规划路线,算法结束,引导无人船行驶。
在本发明一实施例中,所述改进后的快速拓展随机树RRT算法,即对快速拓展随机树RRT算法,加入设定人工势场和与目标引力函数扩展相结合的扩展策略,具体过程如下:
假设无人船所在点相对于目标点的引力势场为U1,其引力势场的一般形式可表现为
式中,X是无人船当前所在位置,Xg是目标点所在位置,k是引力势场的增益系数;
无人船在该点受到来自目标点的引力为F1,即其所受引力势场的梯度,方向由其当前所在点位置指向目标点位置,公式如下所示
F1(X)=-▽U1(X)=k(X-Xg) (4)
无人船所受引力随其到目标点距离的增加而减小,反之则增加,当无人船到达或无限接近目标点时,其所受引力为0;
在假设无人船在此点受到斥力势场为U2,来自于障碍物,其公式如下
其中,Xb是障碍物的位置坐标,m是斥力势场的增益系数,r为障碍物的影响半径;
因而,无人船受到的斥力F2(X)为其所受斥力势场的负梯度,公式如下
由此可得,无人船受到的合力作用为F,公式如下
F=F1+F2 (7)
无人船在合力F的作用下,躲避障碍,朝着目标点移动;若无人船、目标点和障碍物三者处于同一条直线上,且障碍物位于无人船与目标点之间,目标点对无人船的引力和障碍物对无人船的斥力的合力为零,无人船则陷入局部最小值点,在该局部小范围内反复移动而无法到达目的点;如果遇到这种情形,系统将自动切换为快速拓展随机树进行拓展,跳出此局部最优点。
相较于现有技术,本发明具有以下有益效果:本发明在快速拓展随机树(RRT)算法的基础上引入了人工势场函数和目标引力函数两个函数,克服了扩展随机树随机性高,避免了随机树向目标点相反的方向拓展生长的情况,加入目标引力函数改进了快速扩展随机树缺乏确定性的问题,加入人工势场函数则有效提升了无人船在具体水面环境中的避碰能力,总体提高了无人船在水面路径规划方面的安全性和效率。
附图说明
图1是无人船路径规划流程图。
图2是船体运动控制状态简化结构模型。
图3是经改进的基于RRT的加入人工势场函数和目标引力函数的改进后算法的算法结构简图。
具体实施方式
下面结合附图,对本发明的技术方案进行具体说明。
如图1所示,本发明提供了一种适用于内陆和近海无人船的路径规划方法,包括如下步骤:
步骤S1、对于已知的地图环境,将环境地图进行锐化处理后输入无人船核心处理器;
步骤S2、无人船核心处理器接收环境地图图像信息,并对其进行再次处理,转化为无人船核心处理器能够识别的环境地图电子数据信息;
步骤S3、针对环境地图电子数据信息,综合考虑无人船起点,途径点,终点,用经改进的快速拓展随机树RRT算法介入进行运算,得出整体基本规划路线;
步骤S4、船载核心处理器对步骤S3得出的整体基本规划路线进行B样条曲线圆滑处理,进一步优化路线;
步骤S5、将路径规划路线图传送给无人船船体控制系统,再由无人船船体控制系统对船体进行控制,使其沿步骤S4优化后的路线进行航行。
所述步骤S1具体实现如下:
首先确定一个包含环境地图信息和船体运动状态模型的坐标系;将环境地图进行锐化,空白部分为可行驶区域,阴影部分为障碍物,环境地图信息就可以以横纵坐标系表示,无人船核心处理器就能够读取和识别地图信息;
包含的非完整性约束可由微分方程X=f(x,u)表示,状态转移方程:
所述步骤S2具体实现为:通过船上传感器来感知附近环境信息,结合无人船核心处理器已经获取的环境地图信息,将整个环境地图空间划分为障碍物空间Xobs和无障碍物空间Xfree,障碍物以阴影部分来表示。
所述步骤S3,针对环境地图电子数据信息,利用无人船核心处理器,导入快速拓展随机树RRT算法对其进行路径规划的计算;针对无人船当时的工作场景和所要执行的具体任务,综合考虑到无人船的起始位置,起始状态,路径中所要途径的点以及终点,导入改进后的快速拓展随机树RRT算法进行运算;运算的过程又分为如下步骤:
步骤S31、无人船核心处理器接收环境地图电子数据信息,确定起始点状态和目标点状态;
步骤S32、通过改进后的快速拓展随机树RRT算法进行快速拓展随机树路线拓展;
步骤S33、若遇到障碍物,则提升人工势场函数权重,使无人船避开障碍物;
步骤S34、若距离目标点越来越远,则提升目标引力函数,使无人船向着靠近目标点的方向前进;若无人船距离目标点越来越近,则执行下一步骤;
步骤S35、若算法陷入局部最优点,则说明目标引力函数所占权重过高,此时则需要提升RRT算法权重以便能够跳出局部最优点,继续寻找目标点;若算法没有陷入局部最优点,则执行下一步骤;
步骤S36、判断是否已经到达目标点位置状态,若没有到达目标点位置状态,则降低RRT算法权重,回到步骤S32,继续进行拓展;
步骤S37、若已到达目标点位置状态,则对规划路线进行B样条曲线处理,继续优化路线;
步骤S38、得到最终规划路线,算法结束,引导无人船行驶。
所述改进后的快速拓展随机树RRT算法,即对快速拓展随机树RRT算法,加入设定人工势场和与目标引力函数扩展相结合的扩展策略,具体过程如下:
假设无人船所在点相对于目标点的引力势场为U1,其引力势场的一般形式可表现为
式中,X是无人船当前所在位置,Xg是目标点所在位置,k是引力势场的增益系数;
无人船在该点受到来自目标点的引力为F1,即其所受引力势场的梯度,方向由其当前所在点位置指向目标点位置,公式如下所示
F1(X)=-▽U1(X)=k(X-Xg) (4)
无人船所受引力随其到目标点距离的增加而减小,反之则增加,当无人船到达或无限接近目标点时,其所受引力为0;
在假设无人船在此点受到斥力势场为U2,来自于障碍物,其公式如下
其中,Xb是障碍物的位置坐标,m是斥力势场的增益系数,r为障碍物的影响半径;
因而,无人船受到的斥力F2(X)为其所受斥力势场的负梯度,公式如下
由此可得,无人船受到的合力作用为F,公式如下
F=F1+F2 (7)
无人船在合力F的作用下,躲避障碍,朝着目标点移动;若无人船、目标点和障碍物三者处于同一条直线上,且障碍物位于无人船与目标点之间,目标点对无人船的引力和障碍物对无人船的斥力的合力为零,无人船则陷入局部最小值点,在该局部小范围内反复移动而无法到达目的点;如果遇到这种情形,系统将自动切换为快速拓展随机树进行拓展,跳出此局部最优点。
以下为本发明具体实施实例。
针对RRT搜索算法有时会触碰障碍物和随机性太高的缺点,以及其容易陷入局部最优解的情况,通过分别加入预设的人工势场和目标引力来改进RRT搜索算法。
众所周知,无人船在执行任务时,一旦触碰到礁石、岸基以及其他船只,势必会影响无人船的正常工作,甚至会损伤无人船船体,重则报废,造成更加严重的后果。引入人工势场法,避免无人船触碰障碍物这一点尤其重要。而无人船在执行RRT算法时,因其较高的的随机性,导致其工作效率太过低下,此时就需要引进目标引力函数对其进行大方向上的引导,用以提高它的工作效率。在RRT算法中引入目标引力函数,目标引力函数使随机树朝着目标的位置方向生长,这样不仅避免了随机树对全局空间进行搜索,大大减少了运算量,提高了实时性,而且使规划出的路径尽可能的接近最优路径,并改进了路径的光滑性。
通过对RRT搜索算法进行改进,加入设定人工势场和与目标引力函数扩展相结合的扩展策略,加入势场的过程如下:
假设无人船所在点相对于目标点的引力势场为U1,其引力势场的一般形式可表现为
式中,X是无人船当前所在位置,Xg是目标点所在位置,k是引力势场的增益系数。
无人船在该点受到来自目标点的引力为F1,即其所受引力势场的梯度,方向由其当前所在点位置指向目标点位置,公式如下所示
F1(X)=-▽U1(X)=k(X-Xg) (4)
无人船所受引力随其到目标点距离的增加而减小,反之则增加,当无人船到达或无限接近目标点时,其所受引力为0;
在假设无人船在此点受到斥力势场为U2,来自于障碍物,其公式如下
其中,Xb是障碍物的位置坐标,m是斥力势场的增益系数,r为障碍物的影响半径;
因而,无人船受到的斥力F2(X)为其所受斥力势场的负梯度,公式如下
由此可得,无人船受到的合力作用为F,公式如下
F=F1+F2 (7)
无人船在合力F的作用下,躲避障碍,朝着目标点移动;若无人船、目标点和障碍物三者处于同一条直线上,且障碍物位于无人船与目标点之间,目标点对无人船的引力和障碍物对无人船的斥力的合力为零,无人船则陷入局部最小值点,在该局部小范围内反复移动而无法到达目的点;如果遇到这种情形,系统将自动切换为快速拓展随机树进行拓展,跳出此局部最优点。
经改进后的算法运算流程结构简图如图3所示。其运算步骤如下:
步骤1,无人船船载处理器接收地图信息,确定起始点状态和目标点状态;通过本发明所介绍的方法建立环境坐标系,并将船体位置状态参数化,由船载传感器自动感知,并将船体状态输入船载核心处理器。
步骤2,通过改进后的快速随机拓展树算法进行路线拓展。令Gk为一个有k个节点的快速随机拓展树,且Gk∈Xfree,Xfree为无人船在地图中的无障碍区域时的状态空间,同时Xobs为无人船在地图中的障碍区域的状态空间。X为Gk的节点,X∈Gk。定义Xin it为初始状态,即起点,Xgoal为目标状态即终点,Xgoal∈Xfree为目标区域。令Xrand为空间中一个随机选取的位置状态,同样Xrand∈Xfree,然后再找出Gk中距离Xrand最近的节点Xnear,令D(p,q)表示两个位置状态之间的几何距离,则Xrand和Xnear的关系可以表示为D(Xrand,Xnear)≤D(X,Xrand)。在Xnear与Xnear的连接线上求Xnew,Xnew必须满足的条件是Xnew∈Xfree,且D(Xrand,Xnear)≤ρ(其中ρ>0)。每当一个新的Xnew出现,则Gk就会增加一个新的节点Gk+1,随机选择一个树G,将X_(in it)添加到树G上,再选择一个构型空间Xrand,使Xrand∈Xfree。以固定的步长ρ计算新的节点Xnew,计算公式为:
其中,||Xrand-Xnear||表示欧拉范数定义的Xrand和Xnear之间距离。
不断重复搜索过程,即可在相近两点间得到一条路径。
步骤3,若遇到障碍物,则提升人工势场函数权重,使无人船避开障碍物。当无人船在行驶过程中接近障碍物时,即当||Xrand-Xobs||趋近于我们设定的某一数值时,及时调整各算法函数权重比例,使人工势场函数权重比例上升,避免无人船触碰到障碍物,从而保证无人船安全平稳行驶。
步骤4,若距离目标点越来越远,则提升目标引力函数,使无人船向着靠近目标点的方向前进。若无人船距离目标点越来越近,则执行下一步骤;当||Xrand-Xgoal||增大时,及时调整各个算法所占权重,提升目标引力函数权重,降低快速拓展随机树算法权重,使无人船驶向更加靠近目标点的方向。
步骤5,若算法陷入局部最优点,则说明目标引力函数所占权重过高,此时则需要提升RRT算法权重以便能够跳出局部最优点,继续寻找目标点。若算法没有陷入局部最优点,则执行下一步骤。判断无人船是否行驶至局部最优点时,只需判断||Xrand-Xgoal||的数值是否变化,若保持不变,切不为0,则可以判定其已行驶至局部最优点。此时要跳出局部最优点,就要增加快速拓展随机树的权重比例,利用随机树树枝跳出局部最优点,继续向目标点行驶。
步骤6,判断是否已经到达目标点位置状态,若没有到达目标点位置状态,则降低RRT算法权重,回到步骤2,继续进行拓展。若无人船已行驶至目标点,则||Xrand-Xgoal||数值为0保持不变。若数值不为0,则重新执行步骤2。
步骤7,若已到达目标点位置状态,则对规划路线进行B样条曲线处理,继续优化路线。利用B样条曲线对现有路线进行圆滑化优化处理,可以帮助无人船节省更多的能量,使其拥有更高的续航能力。
步骤8,得到最终规划路线,算法结束,引导无人船行驶。
本发明综合了快速拓展随机树(RRT)和人工势场函数与目标引力函数,在降低快速拓展随机树的随机性的同时,增大跳出局部最优点的能力,使无人船路径规划算法更加完善。
本发明中,最后算法运算到达目标点后,再用B样条曲线对规划路线进行曲线圆滑处理,对规划所得路线进行平滑化处理。使用B样条曲线对其进行处理,可以使无人船在实际航行中减少急停、急加速和急转弯,使其导航路线更加优化,得到无人船最终的执行路线。
以上是本发明的较佳实施例,凡依本发明技术方案所作的改变,所产生的功能作用未超出本发明技术方案的范围时,均属于本发明的保护范围。
Claims (4)
1.一种适用于内陆和近海无人船的路径规划方法,其特征在于,包括如下步骤:
步骤S1、对于已知的地图环境,将环境地图进行锐化处理后输入无人船核心处理器;
步骤S2、无人船核心处理器接收环境地图图像信息,并对其进行再次处理,转化为无人船核心处理器能够识别的环境地图电子数据信息;
步骤S3、针对环境地图电子数据信息,综合考虑无人船起点,途径点,终点,用经改进的快速拓展随机树RRT算法介入进行运算,得出整体基本规划路线;
步骤S4、船载核心处理器对步骤S3得出的整体基本规划路线进行B样条曲线圆滑处理,进一步优化路线;
步骤S5、将路径规划路线图传送给无人船船体控制系统,再由无人船船体控制系统对船体进行控制,使其沿步骤S4优化后的路线进行航行;
所述步骤S1具体实现如下:
首先确定一个包含环境地图信息和船体运动状态模型的坐标系;将环境地图进行锐化,空白部分为可行驶区域,阴影部分为障碍物,环境地图信息就可以以横纵坐标系表示,无人船核心处理器就能够读取和识别地图信息;
包含的非完整性约束可由微分方程X=f(x,u)表示,状态转移方程:
2.根据权利要求1所述的一种适用于内陆和近海无人船的路径规划方法,其特征在于,所述步骤S2具体实现为:通过船上传感器来感知附近环境信息,结合无人船核心处理器已经获取的环境地图信息,将整个环境地图空间划分为障碍物空间Xobs和无障碍物空间Xfree,障碍物以阴影部分来表示。
3.根据权利要求1所述的一种适用于内陆和近海无人船的路径规划方法,其特征在于,所述步骤S3,针对环境地图电子数据信息,利用无人船核心处理器,导入快速拓展随机树RRT算法对其进行路径规划的计算;针对无人船当时的工作场景和所要执行的具体任务,综合考虑到无人船的起始位置,起始状态,路径中所要途径的点以及终点,导入改进后的快速拓展随机树RRT算法进行运算;运算的过程又分为如下步骤:
步骤S31、无人船核心处理器接收环境地图电子数据信息,确定起始点状态和目标点状态;
步骤S32、通过改进后的快速拓展随机树RRT算法进行快速拓展随机树路线拓展;
步骤S33、若遇到障碍物,则提升人工势场函数权重,使无人船避开障碍物;
步骤S34、若距离目标点越来越远,则提升目标引力函数,使无人船向着靠近目标点的方向前进;若无人船距离目标点越来越近,则执行下一步骤;
步骤S35、若算法陷入局部最优点,则说明目标引力函数所占权重过高,此时则需要提升RRT算法权重以便能够跳出局部最优点,继续寻找目标点;若算法没有陷入局部最优点,则执行下一步骤;
步骤S36、判断是否已经到达目标点位置状态,若没有到达目标点位置状态,则降低RRT算法权重,回到步骤S32,继续进行拓展;
步骤S37、若已到达目标点位置状态,则对规划路线进行B样条曲线处理,继续优化路线;
步骤S38、得到最终规划路线,算法结束,引导无人船行驶。
4.根据权利要求1所述的一种适用于内陆和近海无人船的路径规划方法,其特征在于,所述改进后的快速拓展随机树RRT算法,即对快速拓展随机树RRT算法,加入设定人工势场和与目标引力函数扩展相结合的扩展策略,具体过程如下:
假设无人船当前所在点相对于目标点的引力势场为U1,其引力势场的形式表现为
式中,X是无人船当前所在位置,Xg是目标点所在位置,k是引力势场的增益系数;
无人船在当前所在点受到来自目标点的引力为F1,即其所受引力势场的梯度,方向由其当前所在点位置指向目标点位置,公式如下所示
无人船所受引力随其到目标点距离的增加而减小,反之则增加,当无人船到达或无限接近目标点时,其所受引力为0;
在假设无人船在此点受到斥力势场为U2,来自于障碍物,其公式如下
其中,Xb是障碍物的位置坐标,m是斥力势场的增益系数,r为障碍物的影响半径;
因而,无人船受到的斥力F2(X)为其所受斥力势场的负梯度,公式如下
由此可得,无人船受到的合力作用为F,公式如下
F=F1+F2 (7)
无人船在合力F的作用下,躲避障碍,朝着目标点移动;若无人船、目标点和障碍物三者处于同一条直线上,且障碍物位于无人船与目标点之间,目标点对无人船的引力和障碍物对无人船的斥力的合力为零,无人船则陷入局部最小值点,在该局部小范围内反复移动而无法到达目的点;如果遇到这种情形,系统将自动切换为快速拓展随机树进行拓展,跳出此局部最优点。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810959463.9A CN108981716B (zh) | 2018-08-22 | 2018-08-22 | 一种适用于内陆和近海无人船的路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810959463.9A CN108981716B (zh) | 2018-08-22 | 2018-08-22 | 一种适用于内陆和近海无人船的路径规划方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108981716A CN108981716A (zh) | 2018-12-11 |
CN108981716B true CN108981716B (zh) | 2020-06-16 |
Family
ID=64547253
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810959463.9A Active CN108981716B (zh) | 2018-08-22 | 2018-08-22 | 一种适用于内陆和近海无人船的路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108981716B (zh) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109669459B (zh) * | 2018-12-28 | 2022-05-10 | 西北工业大学 | 一种采用不变集的动态反馈路径规划方法 |
CN109737970B (zh) * | 2019-03-21 | 2020-10-27 | 集美大学 | 一种基于改进rrt算法的水面无人艇路径规划方法 |
CN110045732B (zh) * | 2019-03-28 | 2022-06-07 | 暨南大学 | 一种启发式路径规划方法 |
CN110515094B (zh) * | 2019-07-11 | 2022-12-16 | 同济大学 | 基于改进rrt*的机器人点云地图路径规划方法及系统 |
CN110609552B (zh) * | 2019-09-12 | 2022-08-02 | 哈尔滨工程大学 | 一种水下无人航行器编队平面航迹规划方法 |
CN110850873B (zh) * | 2019-10-31 | 2021-06-08 | 五邑大学 | 无人船路径规划方法、装置、设备和存储介质 |
CN111561932B (zh) * | 2020-05-27 | 2023-07-18 | 武汉理工大学 | 一种基于虚拟力的船舶导航方法 |
CN111623780B (zh) * | 2020-06-08 | 2023-09-08 | 大连海事大学 | 一种基于优先级目标分配的多无人船协同路径规划方法 |
CN112809665B (zh) * | 2020-12-16 | 2022-06-07 | 安徽工业大学 | 一种基于改进rrt算法的机械臂运动规划方法 |
CN112904901B (zh) * | 2021-01-14 | 2022-01-21 | 吉林大学 | 一种基于双目视觉slam与融合算法的路径规划方法 |
CN113534844B (zh) * | 2021-08-18 | 2024-02-27 | 广东电网有限责任公司 | 一种未知环境下的旋翼飞行器输电线路巡检方法及装置 |
CN113624241B (zh) * | 2021-10-11 | 2022-01-28 | 中国人民解放军66136部队 | 一种面向进港运动船舶的无人机查证路线规划方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1770365A1 (en) * | 2005-09-30 | 2007-04-04 | Saab Ab | Method for planning the velocity of a craft along a route |
CN106909145A (zh) * | 2017-02-22 | 2017-06-30 | 武汉理工大学 | 无人航道测量船障碍物实时感知避障系统与方法 |
CN106959698A (zh) * | 2017-05-24 | 2017-07-18 | 大连海事大学 | 一种路径跟踪避障制导方法 |
CN107289939A (zh) * | 2017-06-09 | 2017-10-24 | 武汉理工大学 | 基于svm算法的无人船路径规划方法 |
CN206848812U (zh) * | 2017-05-27 | 2018-01-05 | 浙江大学 | 基于ARM Cortex‑M7处理器的无人船平台 |
CN107703934A (zh) * | 2017-08-24 | 2018-02-16 | 北京臻迪科技股份有限公司 | 一种无人船的控制方法及装置 |
-
2018
- 2018-08-22 CN CN201810959463.9A patent/CN108981716B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1770365A1 (en) * | 2005-09-30 | 2007-04-04 | Saab Ab | Method for planning the velocity of a craft along a route |
CN106909145A (zh) * | 2017-02-22 | 2017-06-30 | 武汉理工大学 | 无人航道测量船障碍物实时感知避障系统与方法 |
CN106959698A (zh) * | 2017-05-24 | 2017-07-18 | 大连海事大学 | 一种路径跟踪避障制导方法 |
CN206848812U (zh) * | 2017-05-27 | 2018-01-05 | 浙江大学 | 基于ARM Cortex‑M7处理器的无人船平台 |
CN107289939A (zh) * | 2017-06-09 | 2017-10-24 | 武汉理工大学 | 基于svm算法的无人船路径规划方法 |
CN107703934A (zh) * | 2017-08-24 | 2018-02-16 | 北京臻迪科技股份有限公司 | 一种无人船的控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN108981716A (zh) | 2018-12-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108981716B (zh) | 一种适用于内陆和近海无人船的路径规划方法 | |
CN112650237B (zh) | 基于聚类处理和人工势场的船舶路径规划方法和装置 | |
CN108680163B (zh) | 一种基于拓扑地图的无人艇路径搜索系统及方法 | |
CN108681321B (zh) | 一种无人船协同编队的水下探测方法 | |
CN109597417B (zh) | 一种基于避碰准则的多usv群体协同避碰规划方法 | |
CN113433933B (zh) | 一种智能水面保洁无人船的自主巡航方法 | |
CN107356254B (zh) | 适用于地磁辅助导航航迹规划的粒子群优化方法 | |
CN111399506A (zh) | 一种基于动力学约束的全局-局部混合无人船路径规划方法 | |
CN111829527A (zh) | 一种基于深度强化学习且顾及海洋环境要素的无人船路径规划方法 | |
Ji et al. | Improvement and fusion of A* algorithm and dynamic window approach considering complex environmental information | |
CN111045453A (zh) | 一种基于无人艇与多水下机器人的协同控制系统及方法 | |
CN108762280A (zh) | 一种考虑海洋环流影响的uuv基于能量消耗优化的远程航海路径规划方法 | |
CN114879666A (zh) | 一种基于rrt算法的水面无人艇路径规划方法和装置 | |
CN111412918B (zh) | 无人艇全局安全路径规划方法 | |
CN114387822B (zh) | 船舶避碰方法 | |
CN113325856B (zh) | 基于逆流逼近策略的uuv最优作业路径规划方法 | |
CN111176281A (zh) | 基于象限法的多水面无人艇覆盖式协同搜索方法及系统 | |
CN111256694A (zh) | 一种确定水面无人艇路径的方法 | |
Guo et al. | Mission-driven path planning and design of submersible unmanned ship with multiple navigation states | |
CN114527744A (zh) | 基于天牛须搜索优化的无人帆船路径跟踪制导方法 | |
CN112706760B (zh) | 一种用于特殊道路场景的无人驾驶泊车路径规划方法 | |
Yang et al. | Fast marine route planning for UAV using improved sparse A* algorithm | |
CN112880678A (zh) | 一种复杂水域环境中无人艇航行规划方法 | |
CN115657683B (zh) | 一种可用于巡检作业任务的无人无缆潜水器实时避障方法 | |
CN116952239A (zh) | 一种基于改进a*与dwa融合的无人艇路径规划方法 |
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 |