CN112114584A - 一种球形两栖机器人的全局路径规划方法 - Google Patents
一种球形两栖机器人的全局路径规划方法 Download PDFInfo
- Publication number
- CN112114584A CN112114584A CN202010818259.2A CN202010818259A CN112114584A CN 112114584 A CN112114584 A CN 112114584A CN 202010818259 A CN202010818259 A CN 202010818259A CN 112114584 A CN112114584 A CN 112114584A
- Authority
- CN
- China
- Prior art keywords
- node
- path
- target points
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 44
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 54
- 239000011159 matrix material Substances 0.000 claims abstract description 19
- 238000011156 evaluation Methods 0.000 claims description 37
- 239000003016 pheromone Substances 0.000 claims description 36
- 241000257303 Hymenoptera Species 0.000 claims description 27
- 238000005457 optimization Methods 0.000 claims description 16
- 230000004927 fusion Effects 0.000 claims description 13
- 230000008569 process Effects 0.000 claims description 8
- 230000004888 barrier function Effects 0.000 claims description 5
- 238000012805 post-processing Methods 0.000 claims description 5
- 230000002457 bidirectional effect Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000004088 simulation Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000002431 foraging effect Effects 0.000 description 4
- 230000006872 improvement Effects 0.000 description 3
- 238000011161 development Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000005265 energy consumption Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000010845 search algorithm Methods 0.000 description 1
- 230000003068 static effect 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/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06N—COMPUTING ARRANGEMENTS BASED ON SPECIFIC COMPUTATIONAL MODELS
- G06N3/00—Computing arrangements based on biological models
- G06N3/004—Artificial life, i.e. computing arrangements simulating life
- G06N3/006—Artificial life, i.e. computing arrangements simulating life based on simulated virtual individual or collective life forms, e.g. social simulations or particle swarm optimisation [PSO]
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Theoretical Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Biophysics (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Evolutionary Computation (AREA)
- General Health & Medical Sciences (AREA)
- Molecular Biology (AREA)
- Computing Systems (AREA)
- General Engineering & Computer Science (AREA)
- Biomedical Technology (AREA)
- Computational Linguistics (AREA)
- Software Systems (AREA)
- Artificial Intelligence (AREA)
- Life Sciences & Earth Sciences (AREA)
- Health & Medical Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
一种球形两栖机器人的全局路径规划方法,采用A‑Star算法得到两目标点之间的路径,且融合了Floyd算法对路径进行平滑度的优化,依此路径作为目标点之间的距离矩阵,并通过融合蚁群算法解决了多目标点的遍历顺序问题,缩短了路径的长度,能够结合各目标点之间的路径情况,使得两栖机器人完成全局的路径规划。
Description
(一)技术领域:
本发明属于球形两栖机器人领域,具体涉及一种球形两栖机器人的全局路径规划方法。
(二)背景技术:
目前,两栖机器人因其具备环境适应性强、运动高度灵活等优势而被广泛应用,包括多目标点巡航、搜寻救援、勘测探索、管道检查、资源开发、渔业捕捞等方面。机器人的路径规划研究已经成为当前机器人技术中较为重要的研究课题之一。而路径规划的发展也为机器人走向实用、更安全更可靠地执行任务提供了安全保障。目前大多数的机器人规划出的路径由于转折点较多,使得路径不平滑,从而导致效率低下且耗能大,并且只能对单一的目标点进行路径规划,已无法满足现在社会的需求,如果能找到一条转折点较少,路径较平滑,且能使机器人完成多个目标点的路径显得尤为重要,本方法针对以上问题,首先融合了Floyd算法平滑路径,其次融合蚁群算法使得机器人完成多个目标点的任务。
发明内容:
本发明的目的在于提供一种球形两栖机器人的全局路径规划方法,既解决了现有技术中路径由于转折点较多,导致路径不平滑的问题,又解决了只能对单一目标点路径规划的问题,是一种操作简单容易实现的路径规划方法。
本发明的技术方案:一种球形两栖机器人的全局路径规划方法,其特征在于它具体包括如下步骤:
(1)通过两栖机器人所配置的激光雷达全局环境信息进行采集,得到能够描述作业环境信息的环境图像信号;
(2)根据步骤(1)采集到的环境图像信号,基于栅格法,创建两栖机器人的作业环境模型;
(3)基于步骤(1)创建的两栖机器人的作业环境模型,利用A-Star算法规划出每两个目标点的路径;
所述步骤(3)中采用A-Star算法规划每两个目标点间的规划路径,由以下步骤构成:
(3-1)建立存放待考察节点的Open列表和存放从Open列表中选出的即考察到的,且评价函数最低的节点的Closed列表,Closed列表中所有的节点将组成最终的路径;所述待考察节点由A-Star算法原理直接给出,从起点开始,以起点为中心,周围与之相邻的节点,即为待考察节点;此外,从待考察节点中选出评价函数最低的节点,再以评价函数最低的节点为中心,周围与之相邻的节点,也是待考察节点;直到找到目标点为止,待考察节点包括已经考察过的节点,或者含有障碍物的节点;
(3-2)确定起始栅格节点S,把起始栅格节点S归入Open列表中;
(3-3)在Open列表中进行选择,根据式(1)所示的评价函数,计算Open列表中的每个待考察节点的评价函数,并从中选择评价函数最低的节点放入到Closed列表中;
F(i)=G(i)+H(i) (1)
其中,i表示第i个节点,G(i)表示从起始栅格节点S到第i个节点的付出代价值,H(i)表示从第i个节点到目标点T的预测代价值。
(3-4)若此时Open列表为空,也就是指以当前节点为中心,Open列表中的待考查的节点分为两大类,一类是障碍物栅格不能通过,另一类则是已经放入到了Closed列表中,导致待考察的节点都不能选择,此时,两种情况都会导致表现为Open列表为空,意味着路径规划失败;若此时Open列表为非空,则查找Open列表中评价函数F(i)最小的节点,将其作为当前节点A,并将该节点A放入到Closed列表中;
(3-5)判断步骤(3-4)中选取的节点A是否为目标点,如果是,则流程结束;反之,则以该节点A为父节点在其周围进行子节点扩展,并进行扩展后处理;
所述步骤(3-5)中对子节点进行扩展后处理具体是指:
(3-5-1)若待扩展的子节点即不在Closed列表中,也不在Open列表中,同时也不在障碍栅格中,则把该节点加入到Open表中;
(3-5-2)若待扩展的子节点在Closed列表中或者是障碍栅格中,则跳过该子节点;
(3-5-3)若在Open列表中已经有该子节点,则判断该子节点的评价函数F(i)值是否小于Open列表中的评价函数F(i)值,如果是,则更新Open列表中的评价函数F(i)值,依此将待扩展的子节点遍历,并找到评价函数F(i)值最小的子节点。
(3-6)根据(3-5)步骤继续进行子节点扩展,直到当目标节点被放入到Closed列表时,则停止搜索,表明找到从起点到目标点通行的路径;当Open列表为空且目标节点未被找到时,也要停止搜索,标明此时没有能通行的路径。
(4)利用融合Floyd算法对步骤(3)规划出的目标点之间的路径进行平滑度优化,进而得到优化后的路径,并生成距离矩阵E;
所述步骤(4)中利用融合Floyd算法对步骤(3)规划出的目标点之间的路径进行平滑度优化,进而得到优化后的路径,并生成距离矩阵E,步骤如下:
(4-1)删除路径节点在同一线上的中间节点,只保留起点、拐点和终点,从而减少计算量;
(4-2)从起始栅格节点S开始,在保留的路径节点之间每隔k步长取点,每取一个点,判断该节点与前一端路径节点之间是否有障碍物,并由公式计算路径旁边障碍物到路径的距离d,如式(2):
式中,xe、ye为障碍点的坐标,xa,ya是取步长k之前的节点,xb,yb为取步长k之后的节点;
判断该距离d与安全距离D的大小,若在安全距离之外,则该节点满足路径要求,选择当前节点为路径节点,否则不选择;因此,减少了路径的转折点,使得路径变得平滑,且距离也会缩短;
所述步骤(4-2)中的安全距离D是球形两栖机器人的直径。
(4-3)对规划后的路径进行双向优化,即从目标点反向取点,并按照步骤(4-2)进行距离判断,保存路径,并生成距离矩阵E,该路径则为平滑度优化后的路径;
所述步骤(4-3)中的距离矩阵E保存了每两个目标点间的距离,是二维矩阵,其横纵坐标是相同的,均用1,2,3…表示,分别表示坐标点的位置;
(5)结合步骤(4)优化后的路径,融合蚁群算法确定所有目标点的遍历顺序,并找到一条既能遍历所有目标点又能最终返回起点的最短距离,作为该两栖机器人的移动路径;
所述步骤(5)中融合蚁群算法确定所有目标点的遍历顺序,并找到一条既能遍历所有目标点又能最终返回起点的最短距离,具体包括以下内容:
由于蚁群算法可描述为已知所有目标点的距离,因此,可以在每个目标点只经过一次的前提下,求解一条最短的遍历n个目标点的路径,即:
P=(C1,C2,C3,...Cn) (3)
式中,P为目标点的遍历顺序表示,ci为目标点编号,i=1,2,……,n,d(ci,ci+1)表示相邻编号目标点之间的距离,f(p)遍历n个目标点的路径。
所述目标点的遍历顺序的具体确定方法为:
(5-1)初始化蚁群参数各路径的信息素,蚂蚁数量为m,n为目标点的数量,每一只蚂蚁随机选择n个目标点的某一个目标点为出发点;
(5-2)每只蚂蚁按照如式(5)所示的状态转移概率,计算下一个待访问的目标点,即从第i个目标点移到下一个顶点j,直到所有蚂蚁完成一次周游,即所有目标点被所有蚂蚁遍历;
(5-3)当所有蚂蚁执行完一次循环以后,记录每只蚂蚁经过的路径总长度L以及当前迭代的最短路径,并按公式(6)-(8)的信息素更新公式,更新目标点之间的信息素浓度:
其中,ρ0为信息素挥发系数;Nc为当前蚂蚁迭代次数;Nmax为蚂蚁最大的迭代次数,Δτi,j为目标点i,j之间来自所有蚂蚁的信息素浓度值和,L为第k只蚂蚁在当前搜索中行走距离之和,Q表示信息素的强度;
(5-4)若当迭代次数达到最大,则输出最优遍历顺序,将其作为球形两栖机器人在路径规划过程中所遍历目标点的顺序,从而完成机器人的多目标点路径规划;否则,迭代次数加1,并清空蚂蚁路径记录表,返回步骤(5-2)继续执行。
本发明的工作原理:蚁群算法是一种模拟蚂蚁利用信息素确定觅食路径的方法;在觅食过程中优先选取信息素浓度较高的路径,同时也释放定量的信息素,随着信息素的浓度越来越高,形成正反馈,通过遍历所有路径,选择信息素浓度最高的路径作为最优路径。
本发明的优越性:通过改变传统A-Star算法搜索策略,融合了Floyd算法,对路径进行了平滑度优化,缩短了路径的长度;其次融合蚁群算法解决了多个目标点的遍历顺序问题。
附图说明:
图1为本发明所涉一种球形两栖机器人的全局路径规划方法的融合Floyd算法与蚁群算法的总体原理流程图。
图2为本发明所涉一种球形两栖机器人的全局路径规划方法的平滑度优化后与平滑度优化前的对比图。(其中,图2-a为改进前,图2-b是改进后)。
图3为本发明所涉一种球形两栖机器人的全局路径规划方法中融合Floyd算法对路径进行平滑度优化的原理流程示意图。
图4为本发明所涉一种球形两栖机器人的全局路径规划方法中融合Floyd算法和蚁群算法解决多目标点间路径规划对比图(其中,图4-a为已经融合了Floyd算法,没有融合蚁群算法,图4-b是既融合了Floyd算法,也融合了蚁群算法)。
具体实施方式:
实施例:一种球形两栖机器人的全局路径规划方法,如图1所示,其特征在于它具体包括如下步骤:
(1)通过两栖机器人所配置的激光雷达全局环境信息进行采集,得到能够描述作业环境信息的环境图像信号;
(2)根据步骤(1)采集到的环境图像信号,基于栅格法,创建两栖机器人的作业环境模型;
(3)基于步骤(1)创建的两栖机器人的作业环境模型,利用A-Star算法规划出每两个目标点的路径;
(3-1)建立存放待考察节点的Open列表和存放从Open列表中选出的即考察到的,且评价函数最低的节点的Closed列表,Closed列表中所有的节点将组成最终的路径;所述待考察节点由A-Star算法原理直接给出,从起点开始,以起点为中心,周围与之相邻的节点,即为待考察节点;此外,从待考察节点中选出评价函数最低的节点,再以评价函数最低的节点为中心,周围与之相邻的节点,也是待考察节点;直到找到目标点为止,待考察节点包括已经考察过的节点,或者含有障碍物的节点;
(3-2)确定起始栅格节点S,把起始栅格节点S归入Open列表中;
(3-3)在Open列表中进行选择,根据式(1)所示的评价函数,计算Open列表中的每个待考察节点的评价函数,并从中选择评价函数最低的节点放入到Closed列表中;
F(i)=G(i)+H(i) (1)
其中,i表示第i个节点,G(i)表示从起始栅格节点S到第i个节点的付出代价值,H(i)表示从第i个节点到目标点T的预测代价值;
(3-4)若此时Open列表为空,也就是指以当前节点为中心,Open列表中的待考查的节点分为两大类,一类是障碍物栅格不能通过,另一类则是已经放入到了Closed列表中,导致待考察的节点都不能选择,此时,两种情况都会导致表现为Open列表为空,意味着路径规划失败;若此时Open列表为非空,则查找Open列表中评价函数F(i)最小的节点,将其作为当前节点A,并将该节点A放入到Closed列表中;
(3-5)判断步骤(3-4)中选取的节点A是否为目标点,如果是,则流程结束;反之,则以该节点A为父节点在其周围进行子节点扩展,并进行扩展后处理;
(3-5-1)若待扩展的子节点即不在Closed列表中,也不在Open列表中,同时也不在障碍栅格中,则把该节点加入到Open表中;
(3-5-2)若待扩展的子节点在Closed列表中或者是障碍栅格中,则跳过该子节点;
(3-5-3)若在Open列表中已经有该子节点,则判断该子节点的评价函数F(i)值是否小于Open列表中的评价函数F(i)值,如果是,则更新Open列表中的评价函数F(i)值,依此将待扩展的子节点遍历,并找到评价函数F(i)值最小的子节点。
(3-6)根据(3-5)步骤继续进行子节点扩展,直到当目标节点被放入到Closed列表时,则停止搜索,表明找到从起点到目标点通行的路径;当Open列表为空且目标节点未被找到时,也要停止搜索,标明此时没有能通行的路径。
(4)利用融合Floyd算法对步骤(3)规划出的目标点之间的路径进行平滑度优化,如图2所示,进而得到优化后的路径,并生成距离矩阵E,步骤如下,如图2-b所示:
(4-1)删除路径节点在同一线上的中间节点,只保留起点、拐点和终点,从而减少计算量;
(4-2)从起始栅格节点S开始,在保留的路径节点之间每隔k步长取点,每取一个点,判断该节点与前一端路径节点之间是否有障碍物,并由公式计算路径旁边障碍物到路径的距离d,如式(2):
式中,xe、ye为障碍点的坐标,xa,ya是取步长k之前的节点,xb,yb为取步长k之后的节点;
判断该距离d与安全距离D的大小,安全距离D是球形两栖机器人的直径,若d在安全距离之外,则该节点满足路径要求,选择当前节点为路径节点,否则不选择;因此,减少了路径的转折点,使得路径变得平滑,且距离也会缩短;
(4-3)对规划后的路径进行双向优化,即从目标点反向取点,并按照步骤(4-2)进行距离判断,保存路径,并生成距离矩阵E,该路径则为平滑度优化后的路径;
距离矩阵E保存了每两个目标点间的距离,是二维矩阵,其横纵坐标是相同的,均用1,2,3…表示,分别表示坐标点的位置;比如横坐标是3,代表第三个坐标点的位置,纵坐标是4,代表第四个坐标点的位置,那么它们的交叉处则代表第三个目标点和第四个目标点之间的距离,这个只是一个矩阵用来保存规划好的路径距离,后续融合蚁群算法,直接调用矩阵里的距离就可以。
(5)结合步骤(4)优化后的路径,融合蚁群算法确定所有目标点的遍历顺序,并找到一条既能遍历所有目标点又能最终返回起点的最短距离,作为该两栖机器人的移动路径,如图4所示:
融合蚁群算法确定所有目标点的遍历顺序,并找到一条既能遍历所有目标点又能最终返回起点的最短距离,具体包括以下内容,如图1所示:
由于蚁群算法可描述为已知所有目标点的距离,因此,可以在每个目标点只经过一次的前提下,求解一条最短的遍历n个目标点的路径,即:
P=(C1,C2,C3,...Cn) (3)
式中,P为目标点的遍历顺序表示,ci为目标点编号,i=1,2,……,n,d(ci,ci+1)表示相邻编号目标点之间的距离,f(p)遍历n个目标点的路径。
目标点的遍历顺序的具体确定方法为,如图1所示:
(5-1)初始化蚁群参数各路径的信息素,蚂蚁数量为m,n为目标点的数量,每一只蚂蚁随机选择n个目标点的某一个目标点为出发点;
(5-2)每只蚂蚁按照如式(5)所示的状态转移概率,计算下一个待访问的目标点,即从第i个目标点移到下一个顶点j,直到所有蚂蚁完成一次周游,即所有目标点被所有蚂蚁遍历;
(5-3)当所有蚂蚁执行完一次循环以后,记录每只蚂蚁经过的路径总长度L以及当前迭代的最短路径,并按公式(6)-(8)的信息素更新公式,更新目标点之间的信息素浓度:
其中,ρ0为信息素挥发系数;Nc为当前蚂蚁迭代次数;Nmax为蚂蚁最大的迭代次数,Δτi,j为目标点i,j之间来自所有蚂蚁的信息素浓度值和,L为第k只蚂蚁在当前搜索中行走距离之和,Q表示信息素的强度;
(5-4)若当迭代次数达到最大,则输出最优遍历顺序,将其作为球形两栖机器人在路径规划过程中所遍历目标点的顺序,从而完成机器人的多目标点路径规划;否则,迭代次数加1,并清空蚂蚁路径记录表,返回步骤(5-2)继续执行。
针对本发明的技术改进作如下说明:
(一)A-Star算法是基于栅格地图的一种静态路网中求解最短路径的启发式搜索算法,适用于两栖机器人单目标路径规划,其评价函数如下:
F(i)=G(i)+H(i),式中:
i表示第i个节点;
G(i)表示从起始栅格节点S到该i节点的付出代价值;
H(i)表示从该i节点到目标点T的预测代价值;
A-Star算法中维护两个列表:Open列表和Closed列表;没有考察到的节点放入到Open列表中,考查到的放入Closed列表中,步骤为:
(1)生成Open列表和Closed列表,把起始栅格节点S放入Open列表;
(2)确认Open列表为非空,查找删除Open列表中F(i)值最小的节点,放入到Closed列表中;
(3)当前节点若为目标节点,添加到Closed列表中;
(4)处理当前节点的相邻子节点,被检测的子节点有三种可能的情况:
(4-1)若待扩展的子节点不在Closed列表或Open列表中,同时也不在障碍栅格中,则把该节点加入到Open表中;
(4-2)若待扩展的子节点在Closed列表中或者是障碍栅格中,则跳过该子节点;
(4-3)若在Open列表中已经有该子节点,则判断该子节点的F(i)值是否小于Open列表中的F(i)值,如果是则更新Open列表中的F(i)值,依此将待扩展的子节点遍历,并找到F(i)值最小的子节点。
(5)处理完相邻的子节点,返回(4)循环;
(二)第一处改进:融合Floyd算法对路径进行平滑度的优化,得到优化后的路径,生成距离矩阵E,包括以下步骤:
(1)删除路径节点同一线上的中间节点,只保留起点、拐点和终点。
(2)从起始栅格节点S开始,在保留的路径节点之间每隔k步长取点,每取一个节点与前一端路径节点,判断两点之间是否有障碍物,并由公式计算路径旁边障碍物到路径的距离d,判断与安全距离D的大小(D为机器人的直径),若在安全距离之外,满足要求选择当前节点为路径节点,否则不选择。
其中x0,y0为障碍点的坐标。
(3)对规划后的路径进行双向优化,即从目标点反向取点判断(重复步骤(2)的判断方式)保存路径,生成距离矩阵E。
(三)第二处改进:融合蚁群算法确定所有目标点的遍历顺序,找到一条遍历所有目标点,最终能够返回起点的最短距离。
蚁群算法是一种模拟蚂蚁利用信息素确定觅食路径的方法;在觅食过程中优先选取信息素浓度较高的路径,同时也释放定量的信息素,随着信息素的浓度越来越高,形成正反馈,通过遍历所有路径,选择信息素浓度最高的路径作为最优路径。
蚁群算法可描述为已知所有目标点的距离,在每个目标点只经过一次的前提下,求解一条最短的遍历n个目标点的路径。
P=(C1,C2,C3,...Cn)
Ci为目标点编号,式中d(ci,ci+1)为相邻编号目标点之间的距离,P为目标点的遍历顺序表示,f(p)遍历n个目标点的路径。
步骤如下:
(1)初始化;
(2)构建解空间;
每只蚂蚁随机放在不同目标点,并根据概率选择公式计算下一个待访问的目标点,直到所有目标点被所有蚂蚁遍历;
(3)更新信息素:记录每只蚂蚁经过的路径总长度L以及当前迭代的最短路径,并由信息素更新公式,更新目标点之间的信息素浓度。
(4)判断是否终止,若达到最大的迭代次数,输出最优遍历顺序,否则,迭代次数加1,并清空蚂蚁路径记录表,返回步骤2继续执行。
为了验证融合Floyd算法的可行性,在matlab2017a软件中进行了实验仿真,结果如图2所示,在仿真地图中,圆圈为起始点,三角形为目标点,起始点和目标点之间的实线代表机器人的路径,对比前为没有经过路径优化的路径,路径长度为20.4853,转折点个数为7个,然而优化后的路径长度为19.2606,转折点个数为3个。由图可知,融合Floyd算法在路径长度和路径拐点数都优于传统的A-Star算法,拐点数的减少和路径的缩短,使得机器人的转向次数较少,路径缩短,间接地减少了机器人完成任务的时间,同时减少了机器人的耗能,所以拐点数和路径长度是评价路径优劣的一个重要指标。
为了验证融合蚁群算法的可行性,在matlab2017a软件中进行了实验仿真,结果如图4所示,在仿真地图中,圆圈为起始点,三角形为目标点,起始点和目标点之间的实线代表机器人的路径,对比前为单个目标点的路径规划,对比后为融合了蚁群算法的多目标点的路径规划图,在仿真地图中我们选择了10个点作为机器人需要遍历的目标点,从图中可以看出机器人能够找到一条遍历所有目标点,并且躲避障碍物,最终安全的返回原点,使得机器人能够执行连续目标点的多个任务。
综上,改进的A-Star算法较之于传统A-Star算法有一定的优势。
Claims (9)
1.一种球形两栖机器人的全局路径规划方法,其特征在于它具体包括如下步骤:
(1)对两栖机器人的作业环境信息进行全局采集,得到能够描述作业环境信息的环境图像信号;
(2)根据步骤(1)采集到的环境图像信号,基于栅格法,创建两栖机器人的作业环境模型;
(3)基于步骤(1)创建的两栖机器人的作业环境模型,利用A-Star算法规划出每两个目标点的路径;
(4)利用融合Floyd算法对步骤(3)规划出的目标点之间的路径进行平滑度优化,进而得到优化后的路径,并生成距离矩阵E;
(5)结合步骤(4)优化后的路径,融合蚁群算法确定所有目标点的遍历顺序,并找到一条既能遍历所有目标点又能最终返回起点的最短距离,作为该两栖机器人的移动路径。
2.根据权利要求1所述一种球形两栖机器人的全局路径规划方法,其特征在于所述步骤(1)中对两栖机器人的作业环境信息进行全局采集是通过两栖机器人所配置的激光雷达对全局环境信息进行采集。
3.根据权利要求1所述一种球形两栖机器人的全局路径规划方法,其特征在于所述步骤(3)中采用A-Star算法规划每两个目标点间的规划路径,由以下步骤构成:
(3-1)建立存放待考察节点的Open列表和存放从Open列表中选出的即考察到的,且评价函数最低的节点的Closed列表,Closed列表中所有的节点将组成最终的路径;
(3-2)确定起始栅格节点S,把起始栅格节点S归入Open列表中;
(3-3)在Open列表中进行选择,根据式(1)所示的评价函数,计算Open列表中的每个待考察节点的评价函数,并从中选择评价函数最低的节点放入到Closed列表中;
F(i)=G(i)+H(i) (1)
其中,i表示第i个节点,G(i)表示从起始栅格节点S到第i个节点的付出代价值,H(i)表示从第i个节点到目标点T的预测代价值;
(3-4)若此时Open列表为空,也就是指以当前节点为中心,意味着路径规划失败;若此时Open列表为非空,则查找Open列表中评价函数F(i)最小的节点,将其作为当前节点A,并将该节点A放入到Closed列表中;
(3-5)判断步骤(3-4)中选取的节点A是否为目标点,如果是,则流程结束;反之,则以该节点A为父节点在其周围进行子节点扩展,并进行扩展后处理;
(3-6)根据(3-5)步骤继续进行子节点扩展,直到当目标节点被放入到Closed列表时,则停止搜索,表明找到从起点到目标点通行的路径;当Open列表为空且目标节点未被找到时,也要停止搜索,标明此时没有能通行的路径。
4.根据权利要求3所述一种球形两栖机器人的全局路径规划方法,其特征在于所述步骤(3-5)中对子节点进行扩展后处理具体是指:
(3-5-1)若待扩展的子节点即不在Closed列表中,也不在Open列表中,同时也不在障碍栅格中,则把该节点加入到Open表中;
(3-5-2)若待扩展的子节点在Closed列表中或者是障碍栅格中,则跳过该子节点;
(3-5-3)若在Open列表中已经有该子节点,则判断该子节点的评价函数F(i)值是否小于Open列表中的评价函数F(i)值,如果是,则更新Open列表中的评价函数F(i)值,依此将待扩展的子节点遍历,并找到评价函数F(i)值最小的子节点。
5.根据权利要求1所述一种球形两栖机器人的全局路径规划方法,其特征在于所述步骤(4)中利用融合Floyd算法对步骤(3)规划出的目标点之间的路径进行平滑度优化,进而得到优化后的路径,并生成距离矩阵E,步骤如下:
(4-1)删除路径节点在同一线上的中间节点,只保留起点、拐点和终点,从而减少计算量;
(4-2)从起始栅格节点S开始,在保留的路径节点之间每隔k步长取点,每取一个点,判断该节点与前一端路径节点之间是否有障碍物,并由公式计算路径旁边障碍物到路径的距离d:
式中,xe、ye为障碍点的坐标,xa,ya是取步长k之前的节点,xb,yb为取步长k之后的节点;
判断该距离d与安全距离D的大小,若在安全距离之外,则该节点满足路径要求,选择当前节点为路径节点,否则不选择;
(4-3)对规划后的路径进行双向优化,即从目标点反向取点,并按照步骤(4-2)进行距离判断,保存路径,并生成距离矩阵E,该路径则为平滑度优化后的路径。
6.根据权利要求5所述一种球形两栖机器人的全局路径规划方法,其特征在于所述步骤(4-2)中的安全距离D是球形两栖机器人的直径。
7.根据权利要求5所述一种球形两栖机器人的全局路径规划方法,其特征在于所述步骤(4-3)中的距离矩阵E保存了每两个目标点间的距离,是二维矩阵,其横纵坐标是相同的,均用1,2,3…表示,分别表示坐标点的位置。
9.根据权利要求8所述一种球形两栖机器人的全局路径规划方法,其特征在于所述目标点的遍历顺序的具体确定方法为:
(5-1)初始化蚁群参数各路径的信息素,蚂蚁数量为m,n为目标点的数量,每一只蚂蚁随机选择n个目标点的某一个目标点为出发点;
(5-2)每只蚂蚁按照如式(5)所示的状态转移概率,计算下一个待访问的目标点,即从第i个目标点移到下一个顶点j,直到所有蚂蚁完成一次周游,即所有目标点被所有蚂蚁遍历;
(5-3)当所有蚂蚁执行完一次循环以后,记录每只蚂蚁经过的路径总长度L以及当前迭代的最短路径,并按公式(6)-(8)的信息素更新公式,更新目标点之间的信息素浓度:
其中,ρ0为信息素挥发系数;Nc为当前蚂蚁迭代次数;Nmax为蚂蚁最大的迭代次数,Δτi,j为目标点i,j之间来自所有蚂蚁的信息素浓度值和,L为第k只蚂蚁在当前搜索中行走距离之和,Q表示信息素的强度;
(5-4)若当迭代次数达到最大,则输出最优遍历顺序,将其作为球形两栖机器人在路径规划过程中所遍历目标点的顺序,从而完成机器人的多目标点路径规划;否则,迭代次数加1,并清空蚂蚁路径记录表,返回步骤(5-2)继续执行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010818259.2A CN112114584A (zh) | 2020-08-14 | 2020-08-14 | 一种球形两栖机器人的全局路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010818259.2A CN112114584A (zh) | 2020-08-14 | 2020-08-14 | 一种球形两栖机器人的全局路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112114584A true CN112114584A (zh) | 2020-12-22 |
Family
ID=73804900
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010818259.2A Pending CN112114584A (zh) | 2020-08-14 | 2020-08-14 | 一种球形两栖机器人的全局路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112114584A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113094456A (zh) * | 2021-04-09 | 2021-07-09 | 郑州大学 | 一种机器人行走路径生成方法 |
CN113375686A (zh) * | 2021-04-26 | 2021-09-10 | 北京旷视机器人技术有限公司 | 路径规划的方法、装置以及智能输送系统 |
CN113479105A (zh) * | 2021-07-20 | 2021-10-08 | 钟求明 | 一种基于自动驾驶车辆的智能充电方法及智能充电站 |
CN114089765A (zh) * | 2021-11-22 | 2022-02-25 | 江苏科技大学 | 一种面向城市绿地的割草机器人遍历路径规划方法 |
CN114137587A (zh) * | 2021-12-01 | 2022-03-04 | 西南交通大学 | 一种运动对象的位置估计与预测方法、装置、设备及介质 |
CN115358497A (zh) * | 2022-10-24 | 2022-11-18 | 湖南长理尚洋科技有限公司 | 基于gis技术的智慧全景巡河方法及系统 |
CN115831248A (zh) * | 2023-02-20 | 2023-03-21 | 新疆独山子石油化工有限公司 | 一种反应规则的确定方法、装置、电子设备及存储介质 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106681334A (zh) * | 2017-03-13 | 2017-05-17 | 东莞市迪文数字技术有限公司 | 基于遗传算法的自动搬运小车调度控制方法 |
CN107992038A (zh) * | 2017-11-28 | 2018-05-04 | 广州智能装备研究院有限公司 | 一种机器人路径规划方法 |
CN108413976A (zh) * | 2018-01-23 | 2018-08-17 | 大连理工大学 | 一种面向多工况的爬壁机器人智能路径规划方法及系统 |
CN109213161A (zh) * | 2018-08-31 | 2019-01-15 | 北京航空航天大学 | 基于边缘计算的agv控制系统及方法 |
CN109974711A (zh) * | 2019-04-12 | 2019-07-05 | 重庆渝博创智能装备研究院有限公司 | 一种面向智慧工厂的agv多目标点自主导航方法 |
CN110442125A (zh) * | 2019-07-15 | 2019-11-12 | 电子科技大学 | 一种移动机器人的动态路径规划方法 |
CN110686695A (zh) * | 2019-10-30 | 2020-01-14 | 南京邮电大学 | 基于目标评价因子的自适应蚁群a星混合算法 |
CN110874704A (zh) * | 2019-09-27 | 2020-03-10 | 河南理工大学 | 一种基于Floyd算法的应急救援交通路径优化方法 |
CN111174798A (zh) * | 2020-01-17 | 2020-05-19 | 长安大学 | 一种足式机器人路径规划方法 |
-
2020
- 2020-08-14 CN CN202010818259.2A patent/CN112114584A/zh active Pending
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106681334A (zh) * | 2017-03-13 | 2017-05-17 | 东莞市迪文数字技术有限公司 | 基于遗传算法的自动搬运小车调度控制方法 |
CN107992038A (zh) * | 2017-11-28 | 2018-05-04 | 广州智能装备研究院有限公司 | 一种机器人路径规划方法 |
CN108413976A (zh) * | 2018-01-23 | 2018-08-17 | 大连理工大学 | 一种面向多工况的爬壁机器人智能路径规划方法及系统 |
CN109213161A (zh) * | 2018-08-31 | 2019-01-15 | 北京航空航天大学 | 基于边缘计算的agv控制系统及方法 |
CN109974711A (zh) * | 2019-04-12 | 2019-07-05 | 重庆渝博创智能装备研究院有限公司 | 一种面向智慧工厂的agv多目标点自主导航方法 |
CN110442125A (zh) * | 2019-07-15 | 2019-11-12 | 电子科技大学 | 一种移动机器人的动态路径规划方法 |
CN110874704A (zh) * | 2019-09-27 | 2020-03-10 | 河南理工大学 | 一种基于Floyd算法的应急救援交通路径优化方法 |
CN110686695A (zh) * | 2019-10-30 | 2020-01-14 | 南京邮电大学 | 基于目标评价因子的自适应蚁群a星混合算法 |
CN111174798A (zh) * | 2020-01-17 | 2020-05-19 | 长安大学 | 一种足式机器人路径规划方法 |
Non-Patent Citations (3)
Title |
---|
于业斌;朱茵;: "使用蚁群算法在导航中应用搜寻最短路径", 山东交通科技, no. 06, pages 6 - 7 * |
余文凯,章政,付雪画 等: "基于地图预处理及改进A* 算法的路径规划", 高技术通讯, no. 04, pages 383 - 389 * |
余文凯;章政;付雪画;王昭伟;: "基于地图预处理及改进A~*算法的路径规划", 高技术通讯, no. 04, pages 383 - 389 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113094456A (zh) * | 2021-04-09 | 2021-07-09 | 郑州大学 | 一种机器人行走路径生成方法 |
CN113094456B (zh) * | 2021-04-09 | 2022-09-13 | 郑州大学 | 一种机器人行走路径生成方法 |
CN113375686A (zh) * | 2021-04-26 | 2021-09-10 | 北京旷视机器人技术有限公司 | 路径规划的方法、装置以及智能输送系统 |
CN113479105A (zh) * | 2021-07-20 | 2021-10-08 | 钟求明 | 一种基于自动驾驶车辆的智能充电方法及智能充电站 |
CN114089765A (zh) * | 2021-11-22 | 2022-02-25 | 江苏科技大学 | 一种面向城市绿地的割草机器人遍历路径规划方法 |
CN114137587A (zh) * | 2021-12-01 | 2022-03-04 | 西南交通大学 | 一种运动对象的位置估计与预测方法、装置、设备及介质 |
CN115358497A (zh) * | 2022-10-24 | 2022-11-18 | 湖南长理尚洋科技有限公司 | 基于gis技术的智慧全景巡河方法及系统 |
CN115358497B (zh) * | 2022-10-24 | 2023-03-10 | 湖南长理尚洋科技有限公司 | 基于gis技术的智慧全景巡河方法及系统 |
CN115831248A (zh) * | 2023-02-20 | 2023-03-21 | 新疆独山子石油化工有限公司 | 一种反应规则的确定方法、装置、电子设备及存储介质 |
CN115831248B (zh) * | 2023-02-20 | 2023-06-06 | 新疆独山子石油化工有限公司 | 一种反应规则的确定方法、装置、电子设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112114584A (zh) | 一种球形两栖机器人的全局路径规划方法 | |
CN110887484B (zh) | 基于改进遗传算法的移动机器人路径规划方法及存储介质 | |
CN111504325B (zh) | 一种基于扩大搜索邻域的加权a*算法的全局路径规划方法 | |
CN109115226B (zh) | 基于跳点搜索的多机器人冲突避免的路径规划方法 | |
KR102296507B1 (ko) | 트래킹 네트워크를 포함한 cnn을 사용하여 객체를 트래킹하는 방법 및 이를 이용한 장치 | |
CN112650242A (zh) | 一种基于混合算法的移动机器人路径规划方法 | |
CN109798909A (zh) | 一种全局路径规划的方法 | |
CN109839110A (zh) | 一种基于快速随机搜索树的多目标点路径规划方法 | |
CN109163722B (zh) | 一种仿人机器人路径规划方法及装置 | |
CN105955262A (zh) | 一种基于栅格地图的移动机器人实时分层路径规划方法 | |
CN113359718B (zh) | 移动机器人全局路径规划与局部路径规划融合方法及设备 | |
CN114440916B (zh) | 一种导航方法、装置、设备及存储介质 | |
CN114510057A (zh) | 一种室内环境中基于ros的移动机器人自主导航方法 | |
CN113359768A (zh) | 一种基于改进的a*算法的路径规划方法 | |
CN113865589B (zh) | 一种基于地形坡度的长距离快速路径规划方法 | |
CN114756034B (zh) | 一种机器人实时避障路径规划方法及装置 | |
CN114964261A (zh) | 基于改进蚁群算法的移动机器人路径规划方法 | |
García et al. | An efficient multi-robot path planning solution using A* and coevolutionary algorithms | |
CN114596360A (zh) | 一种基于图拓扑的双阶段主动即时定位与建图算法 | |
CN112947533B (zh) | 复杂小天体表面移动序列轨迹规划方法 | |
CN114815801A (zh) | 一种基于策略-价值网络及mcts的自适应环境路径规划方法 | |
CN113867336A (zh) | 一种适用于复杂场景下移动机器人路径导航及规划方法 | |
CN109798899A (zh) | 一种面向海底未知地形搜索的树扩散启发式路径规划方法 | |
CN112828883A (zh) | 一种未知环境下的机器人环境探索方法及系统 | |
CN109977455B (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 |