CN110764518B - 水下清淤机器人路径规划方法、装置、机器人和存储介质 - Google Patents
水下清淤机器人路径规划方法、装置、机器人和存储介质 Download PDFInfo
- Publication number
- CN110764518B CN110764518B CN201911051780.1A CN201911051780A CN110764518B CN 110764518 B CN110764518 B CN 110764518B CN 201911051780 A CN201911051780 A CN 201911051780A CN 110764518 B CN110764518 B CN 110764518B
- Authority
- CN
- China
- Prior art keywords
- dredging
- bat
- robot
- path
- 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.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/04—Control of altitude or depth
- G05D1/06—Rate of change of altitude or depth
- G05D1/0692—Rate of change of altitude or depth specially adapted for under-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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种水下清淤机器人路径规划方法、装置、机器人和存储介质,采用混合布谷鸟搜索和蝙蝠算法的方法,使清淤机器人在避障的同时能够以最短路径到达清淤目标点。清淤机器人到达目标点后,采用“S”字型对清淤区域进行全面清扫,并且利用几何算法完成避障。通过此水下清淤机器人的路径规划方法,从而完成自动化程度高,人力成本低,环保高效的水下清淤工作。
Description
技术领域
本发明涉及路径规划技术领域,尤其是一种水下清淤机器人路径规划方法、装置、机器人和存储介质。
背景技术
近年来随着智能化技术的迅速发展和产业智慧级的不断推进,智能移动机器人在越来越多的领域里得到了广泛应用,如货物搬运、智慧生产、智能生活、异常环境探测、水下作业等等。
目前,在海洋或河道活动中,由于人自身的局限性,利用自主移动机器人来完成水下作业已经成为必然的趋势了,由于水下清淤机器人携带资源有限,且水下的工作环境复杂,不可预测。为使得水下清淤机器人能够有效的避开障碍物并且高效的完成清淤任务,其水下路径规划技术研究显得十分关键了。
水下路径规划方法有人工势场法、A*搜寻算法、可视图法等。虽然它们在水下路径规划中都取得了不错的成效,但大多数都是应用在无障碍或者静态障碍物的环境下,对于水下存在的动态障碍物未能有效解决,并且单独使用一种算法会避免不了该算法中存在的某种缺陷,寻找到的路径可能不是全局最优。
发明内容
为解决上述问题,本发明的目的在于提供一种水下清淤机器人路径规划方法、装置、机器人和存储介质,采用混合布谷鸟搜索和蝙蝠算法的方法,使清淤机器人在避障的同时能够以最短路径到达清淤目标点。清淤机器人到达目标点后采用S形对清淤区域进行全面清扫,并且利用几何算法完成避障。通过此水下清淤机器人的路径规划方法,从而完成自动化程度高,人力成本低,环保高效的水下清淤工作。
本发明解决其问题所采用的技术方案是:
第一方面,本发明实施例提出了一种水下清淤机器人路径规划方法,包括:
根据水下环境初始化蝙蝠种群的参数,并初始化清淤机器人起始点和清淤目标点的位置;
判断起始点和清淤目标点之间的最短连线是否有静态障碍物,并通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径;
清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障;
清淤机器人到达清淤目标点后,确定其自身的坐标和清淤挖掘点的坐标,并根据欧式公式计算出距离其自身最近的淤泥挖掘区域,其余的淤泥挖掘区域按照S形航线完成清淤,且在清淤过程中利用几何算法进行避障。
进一步,所述蝙蝠种群的参数包括蝙蝠种群的大小、频率fi、脉冲发射率ri、响度Ai,其中频率fi、脉冲发射率ri以及响度Ai的计算公式为:
fi=fmin+(fmax-fmin)β
其中,fmin和fmax为蝙蝠发出的最小频率和最大频率,取值范围为[0,1];α和γ是常数,α和γ的取值范围分别为[0,1]、[0,+∞],通常各取0.9。
进一步,所述通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径,包括:
根据水下环境产生蝙蝠以及蝙蝠巢穴的数量,运用布谷鸟搜索得出当前随机蝙蝠巢穴位置的局部路径最优解并保留,将局部路径最优解作为蝙蝠算法的输入,更新蝙蝠位置并优化,输出全局最优路径。
进一步,所述运用布谷鸟搜索得出当前随机蝙蝠巢穴位置的局部路径最优解并保留,包括:
运用莱维飞行对蝙蝠巢穴位置进行更新,得到一组新的蝙蝠巢穴位置,对这组蝙蝠巢穴位置与上一代的蝙蝠巢穴位置进行对比,用好的蝙蝠巢穴位置替换差的蝙蝠巢穴位置,得到优化的蝙蝠巢穴位置,其中,蝙蝠巢穴位置更新的公式为:
进一步,所述将局部路径最优解作为蝙蝠算法的输入,更新蝙蝠位置并优化,其中更新蝙蝠位置采用以下公式:
进一步,所述将局部路径最优解作为蝙蝠算法的输入,更新蝙蝠位置并优化,其中优化蝙蝠位置采用以下公式:
xnew=xold+εAt
其中,ε为介于[-1,1]的均匀分布随机数,At是第t代所有蝙蝠响度的平均值,xold为当前最优个体,xnew是优化后产生的新个体。
进一步,所述清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障,包括:
判断动态障碍物与清淤机器人与之间的阻塞情况,由以下公式产生:
angledirection=atan 2((Yobs-Yrobot),(Xobs-Xrobot))
angleVrbbot=atan2(Vj,Vi)
|angledirection-angleVrobot|<anglethresh
angleVdiff=|angleVrobot-angleVobs|
其中,angledirection为移动障碍物的方向向量,(Xobs,Yobs)为当前障碍物的坐标,Xrobot,Yrobot)为清淤机器人的坐标;anglevrobot为清淤机器人的速度矢量,Vj,Vi分别是清淤机器人Y轴、X轴的速度矢量;anglethresh为一判断阈值,用来判断动态障碍物是否阻塞清淤机器人前进的路径,若移动障碍物方向向量与清淤机器人速度矢量之差的绝对值小于该阈值,则该动态障碍物阻塞了清淤机器人的前进路径,否则没有造成阻塞;在进行绝对值计算之前,应将anglevrobot和angledirection进行处理,使其在(-π,π)范围之内;angleVdiff为清淤机器人的速度矢量与移动障碍物的速度矢量的绝对值之差。
第二方面,本发明实施例还提出了一种水下清淤机器人路径规划装置,包括:
初始化模块,用于根据水下环境初始化蝙蝠种群的参数,并初始化清淤机器人起始点和清淤目标点的位置;
静态避障模块,用于判断起始点和清淤目标点之间的最短连线是否有静态障碍物,并通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径;
动态避障模块,用于清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障;
清淤航线模块,用于对清淤机器人到达清淤目标点后,确定其自身的坐标和清淤挖掘点的坐标,并根据欧式公式计算出距离其自身最近的淤泥挖掘区域,其余的淤泥挖掘区域按照S形航线完成清淤,且在清淤过程中利用几何算法进行避障。
第三方面,本发明实施例还提出了一种机器人,包括:
至少一个处理器;以及,
与所述至少一个处理器通信连接的存储器;其中,
所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行本发明第一方面所述的方法。
第四方面,本发明实施例还提出了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机可执行指令,所述计算机可执行指令用于使计算机执行本发明第一方面所述的方法。
本发明实施例中提供的一个或多个技术方案,至少具有如下有益效果:本发明提供的一种水下清淤机器人路径规划方法、装置、机器人和存储介质,针对水下清淤路径规划,利用布谷鸟搜索迅速得出局部最优路径,以此局部最优路径为引导使蝙蝠有目的进行搜索,得出全局最佳路径,实现最短路径及进行动态避障。清淤机器人到达清淤区域后,对清淤路线进行规划,清淤过程采用S形清淤路线,并用几何算法进行避障。采用S形清淤路线可以使得淤泥清理更全面,且使用几何算法进行规避障碍物,使得清淤过程更安全。
附图说明
下面结合附图和实例对本发明作进一步说明。
图1是本发明第一实施例中水下清淤机器人路径规划方法的流程简图;
图2是本发明第一实施例中水下清淤机器人路径规划方法的具体流程图;
图3是本发明第一实施例中水下清淤机器人路径规划方法中几何算法原理图;
图4是本发明第一实施例中水下清淤机器人路径规划方法中基于几何算法的路径规划流程图;
图5是本发明第二实施例中水下清淤机器人路径规划装置的结构简图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
需要说明的是,如果不冲突,本发明实施例中的各个特征可以相互结合,均在本发明的保护范围之内。另外,虽然在装置示意图中进行了功能模块划分,在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于装置中的模块划分,或流程图中的顺序执行所示出或描述的步骤。
下面结合附图,对本发明实施例作进一步阐述。
如图1所示,本发明的第一实施例提供了一种水下清淤机器人路径规划方法,包括但不限于以下步骤:
S100:根据水下环境初始化蝙蝠种群的参数,并初始化清淤机器人起始点和清淤目标点的位置;
S200:判断起始点和清淤目标点之间的最短连线是否有静态障碍物,并通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径;
S300:清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障;
S400:清淤机器人到达清淤目标点后,确定其自身的坐标和清淤挖掘点的坐标,并根据欧式公式计算出距离其自身最近的淤泥挖掘区域,其余的淤泥挖掘区域按照S形航线完成清淤,且在清淤过程中利用几何算法进行避障。
优选地,本发明具体实施步骤可以进一步细分如下,如图2所示:
步骤1:采用声纳装置获取水下环境信息。
步骤2:初始化随机种群的大小(蝙蝠/巢的数量),频率fi,脉冲发射率ri,响度Ai。
其中蝙蝠/巢的数量是根据水下的实际情况来确定的不同的水下环境大小,所需数量是不同的。频率fi、脉冲发射率ri,响度Ai的计算公式为:
fi=fmin+(fmax-fmin)β 1-1
其中,其中fmin和fmax为蝙蝠发出的最小频率和最大频率,取值范围为[0,1],是服从均匀分布的随机向量;其中α和γ是常数,α和γ的取值范围分别为[0,1]、[0,+∞],通常各取0.9。
步骤3:初始化清淤机器人起始点和目标点的位置。
步骤4:清淤机器人判断起始点和清淤目标点之间的最短连线是否有静态障碍物。
若无,则清淤机器人按照起始点和清淤目标点之间的最短连线进行移动。移动期间是否检测到动态障碍物,若存在则跳到步骤13;若无,则朝着清淤目标点前进。当清淤机器人完成移动后,判断其是否已经到达了目标点,若到达了,则开始清淤,若无,则返回步骤3。
若存在障碍,则启用混合布谷鸟搜索和蝙蝠算法。
步骤5:清淤机器人根据水下实际情况产生蝙蝠以及蝙蝠巢穴的数量。
步骤6:运用布谷鸟搜索得出当前随机蝙蝠巢穴位置最优解,保留当前最优解。
步骤7:运用莱维飞行对蝙蝠巢穴位置进行更新,得到一组新的蝙蝠巢穴位置,对这组蝙蝠巢穴位置与上一代蝙蝠巢穴位置进行对比,用好的蝙蝠巢穴位置替换差的蝙蝠巢穴位置,得到较优的蝙蝠巢穴位置。蝙蝠巢穴位置更新的公式为:
步骤8:运用算法去模拟巢穴的外来鸟蛋被鸟窝主人发现,被发现外来鸟蛋的巢穴进行随机位置更新,保留未被发现外来鸟蛋巢穴的位置,得到一组新的巢穴的位置。再将这组巢穴位置进行测试,与之前的巢穴位置的测试值进行对比,用测试值较好的巢穴的位置替换测试值较差的巢穴的位置。
进行模拟外来鸟蛋被发现,并进行位置更新的公式为:
步骤9:找出上述步骤8中最后得出的最优巢穴的位置。若到达迭代停止条件,则将局部路径最优解输入到蝙蝠算法中。若没有达到,则返回步骤7。
步骤10:蝙蝠算法通过布谷鸟搜索给出的局部路径最优解作为输入,更新自身的位置。
步骤11:由生成的均匀分布随机数P与脉冲发射率进行比较ri,若生成的随机数大于脉冲发射率ri,对最佳解的位置进行优化。否则,进入下一步。
对最佳解进行优化的公式为:
xnew=xold+εAt 1-9
其中ε为[-1,1]上的均匀分布随机数,At是第t代所有蝙蝠响度的平均值,xold为当前最优个体,xnew是优化后产生的新个体。
P为[0,1]上的均匀分布随机数。脉冲发射率ri∈(0,1]。
步骤12:对蝙蝠的飞行后的新旧位置进行比较,用较好的值去替换较差的值。然后找出最优解,判断是否达到最大迭代次数,若没有达到,则返回步骤10,若达到则输出全局最优路径。
步骤13:清淤机器人根据规划好的路径朝着清淤目标点进行移动。清淤机器人在行走过程中,有一探测仪在一定范围内探测周围是否存在动态障碍物。
若存在动态障碍物,则判断该动态障碍物是否阻塞清淤机器人要前进的路径,若造成了阻塞,则清淤机器人将进入下一步判断:情况1、清淤机器人与动态障碍物大致同向运动;情况2、清淤机器人与动态障碍物大致面对面进行移动;情况3、清淤机器人与动态障碍物朝着不同的方向运动。对于情况1,清淤机器人只需跟随障碍物,直至障碍物改变方向,或者规划好的路径使机器人远离障碍物。对于情况2,则需要重新规划路径,使清淤机器人绕开移动障碍物并且回到原路径上。对于情况3,清淤机器人只需按照原规划路径进行移动即可。若没有造成阻塞,清淤机器人按照原规划路径进行移动。
若没有动态障碍物,清淤机器人按照原规划路径进行移动。
判断动态障碍物是否造成阻塞及造成阻塞后清淤机器人与动态障碍物的三种情况,由如下计算公式产生:
angledirection=a tan 2((Yobs-Yrobot),(Xobs-Xrobot)) 1-10
其中angledirection为移动障碍物的方向向量,(Xobs,Yobs)为当前障碍物的坐标,(Xrobot,Yrobot)为清淤机器人的坐标。
angleVrbbot=atan2(Vj,Vi) 1-11
其中anglevrobot为清淤机器人的速度矢量,Vj,Vi分别是清淤机器人Y轴、X轴的速度矢量。
|angledirection-angleVrobot|<anglethresh 1-12
其中anglethresh为一判断阈值,用来判断动态障碍物是否阻塞清淤机器人前进的路径。若移动障碍物方向向量与清淤机器人速度矢量之差的绝对值小于该阈值,则该动态障碍物阻塞了清淤机器人的前进路径,否则没有造成阻塞。在进行绝对值计算之前,应将anglevrobot和angledirection进行处理,使其在(-π,π)范围之内。
angleVdiff=|angleVrobot-angleVobs| 1-13
其中angleVdiff为清淤机器人的速度矢量与移动障碍物的速度矢量的绝对值之差。angleVobs可利用计算公式1-11得出。
若利用计算公式1-12进行判断得出动态障碍物阻塞清淤机器人前进的路径后,利用计算公式1-13得出的angleVdiff进行上述三种情况判断:若abgleVdiff<abglethresh
则对应于上述情况1;若angleVdiff<π-anglethresh则对应于上述情况2;若angleVdiff不在上述范围内,则对应于上述情况3。
针对上述情况2所要进行的路径重新规划给出了如下方法:清淤机器人通过移动障碍物的方向向量和速度矢量,对移动障碍物的运动进行预测。将移动障碍物所要经过的位置坐标进行无效化。然后以清淤机器人当前位置为起点位置,以距离移动障碍物最近,且清淤机器人不与移动障碍物发生碰撞的原路径上的坐标为目标位置,利用混合布谷鸟搜索和蝙蝠算法进行路径规划,使得清淤机器人绕开移动障碍物,并回到原路径规划上,按原路径规划向清淤目标点继续前进。
步骤14清淤机器人按照原规划路径走完后判断是否到达了目标点,若无,则返回步骤3,若到达目标点则开始进行清淤。
清淤机器人在清淤区域行走过程采用S形清淤路线,若遇到障碍物则根据几何算法来规避,具体原理如下:
如图3所示,Pi是现在点,S是淤泥挖掘目标点,连接PiS。若没有障碍物则航行器沿着PiS到达目标点,由于航线进入了圆形障碍区域Oj的范围,则必须绕过障碍区。图3中,圆Oj是与线段PiS相交且圆心距最短的圆。过Pi作圆Oj的切线,得PiQj和PiQ′j,由于∠QjPjS<∠Q′jPjS,取线段PiQj作为航经路段,过S作圆Oj的切线,取切点距Oj近的切点Hj。若线段PiQj没有与圆相交,则以Hj为现在点继续判断Pi+1=Hj,路径为PiQj和劣弧QjHj。若线段PiQj与圆相交,且距圆最近的圆为Ok,则Pi+1=Hk。
路径为PiQk和劣弧QkHk,路径规划算法的整体流程如图4所示。若∠QjPiS=∠Q′jPiS,则保留路径,直至两条路径重合到一点,保留长度短的路径,再按图4所示方法执行。
步骤15:清淤机器人达到清淤区域后,确定自身的坐标和清淤挖掘点的坐标。
步骤16:清淤机器人根据欧式公式计算得出其距离最近的第一淤泥挖掘区域。
步骤17:剩下的区域按照S形航线完成该区域的清淤任务,清淤过程中遇到障碍物,机器人将根据几何算法规避。
步骤18:清淤机器人完成第一区域任务后,返回执行步骤3到步骤17,完成第二区域的清理,往后,以此类推。
综上所述,针对清淤机器人对水下清淤路径的规划,该路径规划先采用混合布谷鸟搜索和蝙蝠算法的方法到达清淤目标点。布谷鸟搜索可以迅速找到到达目标点的路径,但找到的路径可能只是局部最佳路径。蝙蝠算法可以找到全局最佳路径,但由于其是随机迭代的方式,可能算法难以收敛,搜索时间久。而混合布谷鸟搜索和蝙蝠算法可以拟补缺点,发挥出各自算法的优势,利用布谷鸟搜索迅速得出局部最优路径,以此局部最优路径为引导使蝙蝠有目的进行搜索,得出全局最佳路径,实现最短路径及进行动态避障。清淤机器人到达清淤区域后,对清淤路线进行规划,清淤过程采用S形清淤路线,并用几何算法进行避障。采用S形清淤路线可以使得淤泥清理更全面,且使用几何算法进行规避障碍物,使得清淤过程更安全。
另外,如图5所示,本发明的第二实施例提供了一种水下清淤机器人路径规划装置,包括:
初始化模块110,用于根据水下环境初始化蝙蝠种群的参数,并初始化清淤机器人起始点和清淤目标点的位置;
静态避障模块120,用于判断起始点和清淤目标点之间的最短连线是否有静态障碍物,并通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径;
动态避障模块130,用于清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障;
清淤航线模块140,用于对清淤机器人到达清淤目标点后,确定其自身的坐标和清淤挖掘点的坐标,并根据欧式公式计算出距离其自身最近的淤泥挖掘区域,其余的淤泥挖掘区域按照S形航线完成清淤,且在清淤过程中利用几何算法进行避障。
本实施例中的水下清淤机器人路径规划装置与第一实施例中的水下清淤机器人路径规划方法基于相同的发明构思,因此,本实施例中的水下清淤机器人路径规划系统具有相同的有益效果:利用布谷鸟搜索迅速得出局部最优路径,以此局部最优路径为引导使蝙蝠有目的进行搜索,得出全局最佳路径,实现最短路径及进行动态避障。清淤机器人到达清淤区域后,对清淤路线进行规划,清淤过程采用S形清淤路线,并用几何算法进行避障。采用S形清淤路线可以使得淤泥清理更全面,且使用几何算法进行规避障碍物,使得清淤过程更安全。
本发明的第三实施例还提供了一种机器人,包括:
至少一个处理器;
以及与所述至少一个处理器通信连接的存储器;
其中,所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行如上述第一实施例中任意一种水下清淤机器人路径规划方法。
存储器作为一种非暂态计算机可读存储介质,可用于存储非暂态软件程序、非暂态性计算机可执行程序以及模块,如本发明实施例中的虚拟影像控制方法对应的程序指令/模块。处理器通过运行存储在存储器中的非暂态软件程序、指令以及模块,从而执行立体成像处理装置的各种功能应用以及数据处理,即实现上述任一方法实施例的水下清淤机器人路径规划方法。
存储器可以包括存储程序区和存储数据区,其中,存储程序区可存储操作系统、至少一个功能所需要的应用程序;存储数据区可存储根据立体成像处理装置的使用所创建的数据等。此外,存储器可以包括高速随机存取存储器,还可以包括非暂态存储器,例如至少一个磁盘存储器件、闪存器件、或其他非暂态固态存储器件。在一些实施例中,存储器可选包括相对于处理器远程设置的存储器,这些远程存储器可以通过网络连接至该立体投影装置。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
所述一个或者多个模块存储在所述存储器中,当被所述一个或者多个处理器执行时,执行上述任意方法实施例中的水下清淤机器人路径规划方法,例如第一实施例中的方法步骤S100至S400。
本发明的第四实施例还提供了一种计算机可读存储介质,所述计算机可读存储介质存储有计算机可执行指令,该计算机可执行指令被一个或多个控制处理器执行,可使得上述一个或多个处理器执行上述方法实施例中的一种水下清淤机器人路径规划方法,例如第一实施例中的方法步骤S100至S400。
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。
通过以上的实施方式的描述,本领域普通技术人员可以清楚地了解到各实施方式可借助软件加通用硬件平台的方式来实现,当然也可以通过硬件。本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random Access Memory,RAM)等。
以上是对本发明的较佳实施进行了具体说明,但本发明并不局限于上述实施方式,熟悉本领域的技术人员在不违背本发明精神的前提下还可作出种种的等同变形或替换,这些等同的变形或替换均包含在本申请权利要求所限定的范围内。
Claims (10)
1.一种水下清淤机器人路径规划方法,其特征在于,包括:
根据水下环境初始化蝙蝠种群的参数,并初始化清淤机器人起始点和清淤目标点的位置;
判断起始点和清淤目标点之间的最短连线是否有静态障碍物,并通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径;
清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障;
清淤机器人到达清淤目标点后,确定其自身的坐标和清淤挖掘点的坐标,并根据欧式公式计算出距离其自身最近的淤泥挖掘区域,其余的淤泥挖掘区域按照S形航线完成清淤,且在清淤过程中利用几何算法进行避障。
3.根据权利要求1所述的一种水下清淤机器人路径规划方法,其特征在于,所述通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径,包括:
根据水下环境产生蝙蝠以及蝙蝠巢穴的数量,运用布谷鸟搜索得出当前随机蝙蝠巢穴位置的局部路径最优解并保留,将局部路径最优解作为蝙蝠算法的输入,更新蝙蝠位置并优化,输出全局最优路径。
6.根据权利要求3所述的一种水下清淤机器人路径规划方法,其特征在于,所述将局部路径最优解作为蝙蝠算法的输入,更新蝙蝠位置并优化,其中优化蝙蝠位置采用以下公式:
xnew=xold+εAt
其中,ε为介于[-1,1]的均匀分布随机数,At是第t代所有蝙蝠响度的平均值,xold为当前最优个体,xnew是优化后产生的新个体。
7.根据权利要求1所述的一种水下清淤机器人路径规划方法,其特征在于,所述清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障,包括:
判断动态障碍物与清淤机器人与之间的阻塞情况,由以下公式产生:
angledirection=a tan 2((Yobs-Yrobot),(Xobs-Xrobot))
angleVrbbot=a tan 2(Vj,Vi)
|angledirection-angleVrobot|<anglethresh
angleVdiff=|angleVrobot-angleVobs|
其中,angledirection为移动障碍物的方向向量,(Xobs,Yobs)为当前障碍物的坐标,(Xrobot,Yrobot)为清淤机器人的坐标;anglevrobot为清淤机器人的速度矢量,Vj,Vi分别是清淤机器人Y轴、X轴的速度矢量;anglethresh为一判断阈值,用来判断动态障碍物是否阻塞清淤机器人前进的路径;angleVdiff为清淤机器人的速度矢量与移动障碍物的速度矢量的绝对值之差。
8.一种水下清淤机器人路径规划装置,其特征在于,包括:
初始化模块,用于根据水下环境初始化蝙蝠种群的参数,并初始化清淤机器人起始点和清淤目标点的位置;
静态避障模块,用于判断起始点和清淤目标点之间的最短连线是否有静态障碍物,并通过采用混合后的布谷鸟搜索和蝙蝠算法来得出全局最优路径;
动态避障模块,用于清淤机器人沿着全局最优路径向清淤目标点移动,并在其移动过程中判断是否存在动态障碍物以实现避障;清淤航线模块,用于对清淤机器人到达清淤目标点后,确定其自身的坐标和清淤挖掘点的坐标,并根据欧式公式计算出距离其自身最近的淤泥挖掘区域,其余的淤泥挖掘区域按照S形航线完成清淤,且在清淤过程中利用几何算法进行避障。
9.一种机器人,其特征在于,包括:
至少一个处理器;以及,
与所述至少一个处理器通信连接的存储器;其中,
所述存储器存储有可被所述至少一个处理器执行的指令,所述指令被所述至少一个处理器执行,以使所述至少一个处理器能够执行如权利要求1-7任一项所述的方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质存储有计算机可执行指令,所述计算机可执行指令用于使计算机执行如权利要求1-7任一项所述的方法。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911051780.1A CN110764518B (zh) | 2019-10-31 | 2019-10-31 | 水下清淤机器人路径规划方法、装置、机器人和存储介质 |
PCT/CN2020/112533 WO2021082709A1 (zh) | 2019-10-31 | 2020-08-31 | 水下清淤机器人路径规划方法、装置、机器人和存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911051780.1A CN110764518B (zh) | 2019-10-31 | 2019-10-31 | 水下清淤机器人路径规划方法、装置、机器人和存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110764518A CN110764518A (zh) | 2020-02-07 |
CN110764518B true CN110764518B (zh) | 2021-05-11 |
Family
ID=69334954
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911051780.1A Active CN110764518B (zh) | 2019-10-31 | 2019-10-31 | 水下清淤机器人路径规划方法、装置、机器人和存储介质 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN110764518B (zh) |
WO (1) | WO2021082709A1 (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110764518B (zh) * | 2019-10-31 | 2021-05-11 | 五邑大学 | 水下清淤机器人路径规划方法、装置、机器人和存储介质 |
CN111930121B (zh) * | 2020-08-10 | 2022-10-25 | 哈尔滨工程大学 | 一种室内移动机器人的混合路径规划方法 |
CN112100824B (zh) * | 2020-08-26 | 2024-02-27 | 西安工程大学 | 一种改进的布谷鸟算法及优化机器人结构参数的方法 |
CN114237240B (zh) * | 2021-12-07 | 2023-10-27 | 内蒙古黄陶勒盖煤炭有限责任公司 | 智能清淤机器人及其行走控制方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3029537A1 (en) * | 2014-12-03 | 2016-06-08 | Xiaomi Inc. | Mute operation method and apparatus for automatic cleaning device |
CN106647808A (zh) * | 2017-01-05 | 2017-05-10 | 南宁市健佳网络科技有限公司 | 一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法 |
CN106826834A (zh) * | 2016-12-26 | 2017-06-13 | 南京熊猫电子股份有限公司 | 一种机器人焊接自动寻位方法 |
CN107168309A (zh) * | 2017-05-02 | 2017-09-15 | 哈尔滨工程大学 | 一种基于行为的多水下机器人路径规划方法 |
CN207281588U (zh) * | 2017-05-25 | 2018-04-27 | 扬州大学 | 一种清淤机器人的清淤路径勘探系统 |
CN108301456A (zh) * | 2018-01-16 | 2018-07-20 | 广东联芯智能科技有限公司 | 水底清污机器人及其使用方法 |
CN108303092A (zh) * | 2018-01-12 | 2018-07-20 | 浙江国自机器人技术有限公司 | 一种自行规划路径的清洗方法 |
CN108829137A (zh) * | 2018-05-23 | 2018-11-16 | 中国科学院深圳先进技术研究院 | 一种机器人目标追踪的避障方法及装置 |
CN109183884A (zh) * | 2018-09-30 | 2019-01-11 | 苏州凯财速诚电子科技有限公司 | 一种基于疏浚机器人的智能控制及效率协同优化系统 |
CN109782807A (zh) * | 2019-03-08 | 2019-05-21 | 哈尔滨工程大学 | 一种回形障碍物环境下的auv避障方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5112666B2 (ja) * | 2006-09-11 | 2013-01-09 | 株式会社日立製作所 | 移動装置 |
KR101048098B1 (ko) * | 2008-09-03 | 2011-07-11 | 한국과학기술원 | 로봇의 경로계획 장치 및 방법 |
BE1018564A4 (nl) * | 2009-01-12 | 2011-03-01 | Dredging Int | Werkwijze en inrichting voor het aansturen van een mobiele grondbehandelinrichting. |
CN103760907B (zh) * | 2013-12-30 | 2016-05-04 | 哈尔滨工程大学 | 一种基于布谷鸟搜索算法的水下潜器三维路径规划方法 |
CN107272705B (zh) * | 2017-07-31 | 2018-02-23 | 中南大学 | 一种智能环境下机器人路径的多神经网络控制规划方法 |
CN107368076B (zh) * | 2017-07-31 | 2018-03-27 | 中南大学 | 一种智能环境下机器人运动路径深度学习控制规划方法 |
US10795377B2 (en) * | 2018-01-03 | 2020-10-06 | AI Incorporated | Method for autonomously controlling speed of components and functions of a robot |
CN108415434B (zh) * | 2018-03-29 | 2021-05-25 | 五邑大学 | 一种机器人调度方法 |
CN110764518B (zh) * | 2019-10-31 | 2021-05-11 | 五邑大学 | 水下清淤机器人路径规划方法、装置、机器人和存储介质 |
-
2019
- 2019-10-31 CN CN201911051780.1A patent/CN110764518B/zh active Active
-
2020
- 2020-08-31 WO PCT/CN2020/112533 patent/WO2021082709A1/zh active Application Filing
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3029537A1 (en) * | 2014-12-03 | 2016-06-08 | Xiaomi Inc. | Mute operation method and apparatus for automatic cleaning device |
CN106826834A (zh) * | 2016-12-26 | 2017-06-13 | 南京熊猫电子股份有限公司 | 一种机器人焊接自动寻位方法 |
CN106647808A (zh) * | 2017-01-05 | 2017-05-10 | 南宁市健佳网络科技有限公司 | 一种基于模糊控制算法的AUVs搜索和围捕任务分配控制方法 |
CN107168309A (zh) * | 2017-05-02 | 2017-09-15 | 哈尔滨工程大学 | 一种基于行为的多水下机器人路径规划方法 |
CN207281588U (zh) * | 2017-05-25 | 2018-04-27 | 扬州大学 | 一种清淤机器人的清淤路径勘探系统 |
CN108303092A (zh) * | 2018-01-12 | 2018-07-20 | 浙江国自机器人技术有限公司 | 一种自行规划路径的清洗方法 |
CN108301456A (zh) * | 2018-01-16 | 2018-07-20 | 广东联芯智能科技有限公司 | 水底清污机器人及其使用方法 |
CN108829137A (zh) * | 2018-05-23 | 2018-11-16 | 中国科学院深圳先进技术研究院 | 一种机器人目标追踪的避障方法及装置 |
CN109183884A (zh) * | 2018-09-30 | 2019-01-11 | 苏州凯财速诚电子科技有限公司 | 一种基于疏浚机器人的智能控制及效率协同优化系统 |
CN109782807A (zh) * | 2019-03-08 | 2019-05-21 | 哈尔滨工程大学 | 一种回形障碍物环境下的auv避障方法 |
Non-Patent Citations (6)
Title |
---|
A Conceptual Comparison of Firefly Algorithm,Bat Algorithm and Cuckoo Search;Sankalap Arora;《2013 International Conference on Control, Computing, Communication and Materials (ICCCCM)》;20131231;1-4 * |
Optimal Path Planning of Mobile Robot Using Hybrid Cuckoo Search-Bat Algorithm;MBL Saraswathi;《Procedia Computer Science》;20181231;510-517 * |
基于几何法的移动机器人路径规划;曹成才;《计算机应用研究》;20051231(第12期);82-87 * |
基于改进蝙蝠算法和三次样条插值的机器人路径规划;刘景森;《自动化学报》;20190325;1-10 * |
多窄路口下改进的bi-RRT路径规划;龙建全;《仪表技术与传感器》;20190531(第5期);118-123 * |
水下清污机器人避障控制设计;廖伟强;《机械工程与自动化》;20160630(第3期);151-152 * |
Also Published As
Publication number | Publication date |
---|---|
WO2021082709A1 (zh) | 2021-05-06 |
CN110764518A (zh) | 2020-02-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110764518B (zh) | 水下清淤机器人路径规划方法、装置、机器人和存储介质 | |
Hu et al. | Voronoi-based multi-robot autonomous exploration in unknown environments via deep reinforcement learning | |
US11567502B2 (en) | Autonomous exploration framework for indoor mobile robotics using reduced approximated generalized Voronoi graph | |
CN110850873B (zh) | 无人船路径规划方法、装置、设备和存储介质 | |
WO2017041730A1 (zh) | 一种移动机器人避障导航的方法和系统 | |
CN111487864B (zh) | 一种基于深度强化学习的机器人路径导航方法及系统 | |
CN110908377B (zh) | 一种机器人导航空间约简方法 | |
CN112000754A (zh) | 地图构建方法、装置、存储介质及计算机设备 | |
CN109163722B (zh) | 一种仿人机器人路径规划方法及装置 | |
CN110471426B (zh) | 基于量子狼群算法的无人驾驶智能车自动避碰方法 | |
Guth et al. | Underwater SLAM: Challenges, state of the art, algorithms and a new biologically-inspired approach | |
CN112683275B (zh) | 一种栅格地图的路径规划方法 | |
Hernández et al. | A topologically guided path planner for an auv using homotopy classes | |
CN114089752A (zh) | 机器人的自主探索方法、机器人及计算机可读存储介质 | |
CN115562357A (zh) | 一种面向无人机集群的智能路径规划方法 | |
CN113433937B (zh) | 基于启发式探索的分层导航避障系统、分层导航避障方法 | |
CN117389305A (zh) | 一种无人机巡检路径规划方法、系统、设备及介质 | |
CN115143970B (zh) | 一种基于威胁度评估的水下航行器避障方法和系统 | |
Wang et al. | Research on autonomous planning method based on improved quantum Particle Swarm Optimization for Autonomous Underwater Vehicle | |
CN109977455B (zh) | 一种适用于带地形障碍三维空间的蚁群优化路径构建方法 | |
CN114812539B (zh) | 地图探索、地图使用方法、装置、机器人和存储介质 | |
Hernandez et al. | A path planning algorithm for an AUV guided with homotopy classes | |
CN115542896A (zh) | 一种机器人路径生成方法、系统及存储介质 | |
CN114740868A (zh) | 一种基于深度强化学习的移动机器人路径规划方法 | |
CN109901589B (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 |