CN115686020B - 一种基于iapf-a*融合算法的机器人路径规划 - Google Patents
一种基于iapf-a*融合算法的机器人路径规划 Download PDFInfo
- Publication number
- CN115686020B CN115686020B CN202211408188.4A CN202211408188A CN115686020B CN 115686020 B CN115686020 B CN 115686020B CN 202211408188 A CN202211408188 A CN 202211408188A CN 115686020 B CN115686020 B CN 115686020B
- Authority
- CN
- China
- Prior art keywords
- node
- list
- executing
- nodes
- algorithm
- 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
- 230000004927 fusion Effects 0.000 title claims abstract description 8
- 238000000034 method Methods 0.000 claims abstract description 23
- 238000005381 potential energy Methods 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 7
- 238000011156 evaluation Methods 0.000 claims description 6
- 230000004888 barrier function Effects 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 4
- 238000012937 correction Methods 0.000 claims description 3
- 238000012804 iterative process Methods 0.000 claims description 3
- 238000004088 simulation Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 230000004048 modification Effects 0.000 description 4
- 238000012986 modification Methods 0.000 description 4
- 230000007547 defect Effects 0.000 description 3
- 238000005457 optimization Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000006872 improvement Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开一种基于IAPF‑A*融合算法的机器人路径规划方法,算法步骤如图1所示,本发明的有益效果是,通过使用改进的人工势场替换传统A*算法中的估算距离,改进的人工势场不仅包含了终点信息,同时也包含了局部的环境信息,能有效避免凹型障碍物对A*算法的影响,从而提高本发明IAPF‑A*算法的寻路效率。
Description
技术领域
本发明涉及机器人路径规划技术领域,具体是一种基于改进人工势场法(improved Artificial Potential Field,IAPF)与A*的融合算法(IAPF-A*)用于机器人的路径规划问题。
背景技术
路径规划技术是移动机器人研究领域的一个重要组成部分,主要目的是在有障碍物的环境中,根据一定的准则(如路径最短,位置拐点最少,用时最短等),寻求一条从起始位置节点到目标位置节点之间的最优或次优安全无碰路径。
路径规划技术的发展在一定程度上标志着机器人智能水平的高低,而路径规划方法的优劣直接影响路径规划效果。
目前,国内外许多专家学者都在致力于路径规划算法的研究,常用的优化算法主要有人工势场法、免疫算法、蚁群优化算法、神经网络、A*算法等。
其中,A*算法是一种静态环境中求解最短路径最有效的直接搜索方法。A*算法解决路径规划的过程大体上可以概括为:先是通过不断地遍历评价指标F最小的节点,直到遍历到终点节点为止,再使用反向搜索父节点的方法来得到最优路径。其中,某节点的评价指标F等于起点到该节点的实际路径长度G以及该节点到终点的估算路径长度H这两个指标之和。在解决栅格图模型下的路径规划时,通常是定义H为当前节点至终点的坐标之差的绝对值之和。但这会导致A*算法在遍历节点时,往往其遍历的节点是集中于起点至终点的连线方向上的节点集群。显然,这在最优路径与起点至终点的连线较为接近时,能取得较好的结果,但在实际应用中,往往最优路径并不接近于起点至终点的连线,例如在终点方向上的凹型障碍物,此时A*算法为走出凹形障碍物需要进行大量无效的节点遍历,从而导致算法效能过低。
发明内容
本发明的目的在于提供一种基于改进人工势场法(improved ArtificialPotential Field,IAPF)与A*的融合算法(IAPF-A*)的机器人路径规划方法,该方法能够克服传统A*在遍历节点时容易因为碰到凹型障碍物而在局部进行大量无效节点的遍历的缺陷,减少了对无效的节点的遍历,从而提高算法的求解速度。
在传统A*中,某节点A的估算路径长度H仅与节点A与终点的坐标值相关,而在人工势场法中,某节点A的势力场不仅与节点A以及终点的坐标值相关,同时也与A周围的环境相关,因此,通过势力场来构建A*的寻路规则从逻辑的角度来说是具备优势的,但考虑到传统人工势场法也会存在陷入局部较低势场的缺点,本发明首先提出一种改进人工势场法用来生成势力场。具体思路是,不断地将局部势场较低的节点重置为局部较高的节点,避免机器人遍历到该节点上,直到不存在局部较低势场的节点为止。某节点的新势力场pf'的更新公式如式(1)。
式中,pfa为邻接节点的势力场,k为势场变化系数,min()为获取最小值函数。得到势力场数据后,改写A*的评价指标F如式(2)所示,pf'为节点的势力场。
F=G+pf' (2)
本发明解决其技术问题所采用的技术方案是:
一种基于IAPF-A*融合算法的机器人路径规划,包括以下步骤:
S1、初始化算法的相关参数,如包括但不限于:地图数据m、起点S、终点E、空列表A、list_del、list_append、open、close,势场变化系数k=1.1;
S2、根据传统人工势场法APF相关公式(3)、(4)、(5)计算每个节点的势力场pf;
pf=pfatt+pfrep (3)
其中,pfatt与pfrep分别是引力场与斥力场,ζ与η分别是引力、斥力的权重因子,d与D分别为机器人与终点、障碍物的欧氏距离,Q为障碍物的影响半径;
S3、将所有障碍物的邻接节点添加进空列表A;
S4、开始循环;
S5、令势场变化误差delta=0;
S6、依次遍历列表A中的节点,记为节点a,执行S7;遍历结束后执行S13;
S7、检测节点a的邻接节点的势能的最小值,记min(pfa);
S8、若min(pfa)<节点a的势能pf,则执行S9;否则,执行S10;
S9、将节点a添加进list_del,执行S12;
S10、根据式(1)计算节点的新势能pf',并令delta自增势能的前后变化的绝对值;
S11、将节点a的邻接节点添加仅list_append;
S12、将list_append中的节点添加进A;将list_del中的节点从A中删除;执行S6;
S13、若delta为0,则退出势场修正的迭代过程,执行S14;否则执行S5;
S14、根据式(2)计算初始节点的评价指标F,并将节点信息放入到open列表中;
S15、选出open列表中F值最小的节点,若该节点是终点,则执行18,否则执行S16;
S16、同理,由式(2)计算该节点的邻接节点的F值,并加入open列表中;
S17、最后将该节点添加进close列表,执行S15;
S18,由该节点开始,依次查找父节点,直到找到起点,输出遍历过程的节点,即为最短路径。
本发明IAPF-A*在遍历节点时,会预先生成一种改进的人工势场,通过将节点的估算路径长度H替换为势场能,从而实现躲避凹型障碍物的目的。大量的仿真结果表明,采取本文新型策略的IAPF-A*算法在解决机器人路径规划问题上的效果进步明显,整体性能优于基本A*算法和其他一些改进A*算法。
附图说明
下面结合附图和实施例对本发明进一步说明:
图1本发明IAPF-A*算法流程图;
图2传统A*算法运行结果;
图3本发明IAPF-A*算法运行仿真结果;
图4本发明IAPF-A*算法运行结果;
图5文献改进A*算法运行结果。
具体实施方式
本发明的目的在于提供一种基于改进人工势场法(improved ArtificialPotential Field,IAPF)与A*的融合算法(IAPF-A*)用于机器人的路径规划,该方法能够克服传统A*在遍历节点时容易因为碰到凹型障碍物而在局部进行大量无效节点的遍历的缺陷,减少了对无效的节点的遍历,从而提高算法的求解速度。
如图1所示算法流程图,本发明解决其技术问题所采用的技术方案是:
S1、初始化算法的相关参数,如:地图数据m、起点S、终点E、空列表A、list_del、list_append、open、close,势场变化系数k=1.1等;
S2、根据传统人工势场法APF相关公式(3)、(4)、(5)计算每个节点的势力场pf;
pf=pfatt+pfrep (3)
其中,pfatt与pfrep分别是引力场与斥力场,ζ与η分别是引力、斥力的权重因子,d与D分别为机器人与终点、障碍物的欧氏距离,Q为障碍物的影响半径;
S3、将所有障碍物的邻接节点添加进列表A;
S4、开始循环;
S5、令势场变化总量delta=0;
S6、依次遍历列A中的节点,记为节点a,执行S7;遍历结束后执行S13;
S7、检测节点a的邻接节点的势能的最小值,记min(pfa);
S8、若min(pfa)<节点a的势能pf,则执行S9;否则,执行S10;
S9、将节点a添加进list_del,执行S12;
S10、根据式(1)计算节点的新势能pf',并令delta自增势能的前后变化的绝对值;
S11、将节点a的邻接节点添加仅list_append;
S12、将list_append中的节点添加进A;将list_del中的节点从A中删除;执行S6;
S13、若delta为0,则退出势场修正的迭代过程,执行S14;否则执行S5;
S14、根据式(2)计算初始节点的评价指标F,并将节点信息放入到open列表中;
S15、选出open列表中F值最小的节点,若该节点是终点,则执行18,否则执行S16;
S16、同理,由式(2)计算该节点的邻接节点的F值,并加入open列表中;
S17、最后将该节点添加进close列表,执行S15;
S18,由该节点开始,依次查找父节点,直到找到起点,输出遍历过程的节点,即为最短路径。
本发明的有益效果是,通过使用改进的人工势场替换传统A*算法中的估算距离,改进的人工势场不仅包含了终点信息,同时也包含了局部的环境信息,能有效避免凹型障碍物对A*算法的影响,从而提高本发明IAPF-A*算法的寻路效率。
本发明的效果可以通过以下仿真实验进一步说明:
为验证本方法的正确性和合理性,运用python语言编程,在4个20×20的均存在凹型障碍物的栅格环境模型下对本发明IAPF-A*算法进行仿真,并与传统A*算法进行比较。以左上角节点为起点,右下角节点为终点,仿真结果如图2、图3以及表1所示(其中,图2与图3中的红色栅格为被遍历的节点,蓝色为算法所得最优路径节点)。
表1算法实验数据对比
由表1数据可知,当凹型障碍物对算法遍历程度影响较小时(如图2(a)和图3(a)),本发明IAPF-A*算法虽然出于对势力场的运算而导致时间略高于基本的A*算法,但其遍历节点总数目有较为明显的降低,遍历有效率(最优路径节点/总遍历节点)有明显的提升,随着凹型障碍物对节点遍历的影响逐渐加大,本发明IAPF-A*算法的优势开始得以体现,在保证了最终解为最优解的前提下,大幅降低了遍历节点总数目,有效的减少了算法的运行时间,提高路径规划的效率。
为了进一步验证本发明提出的改进算法的有效性,将本发明与另外一种改进的A*算法进行比较,另一种改进的A*算法为期刊《计算机集成制造系统》在2022年第1期中1-17页《优化A*与动态窗口法的移动机器人路径规划》中记载的改进A*算法,在该文章记载的尺寸为50*50栅格环境条件下利用本发明方法进行仿真,并将实验结果进行对比,如图4、图5以及表2所示。
表2仿真结果对比
通过表2中数据可知,本发明IAPF-A*算法所得最优路径结果为75.3259,优于文献改进算法的所得结果76.1543,且本发明算法的遍历节点个数为221,相对于文献改进算法的遍历个数262有明显的减少。因此,本发明IAPF-A*算法相对比文献算法,在寻解效果与遍历有效率方面都有着优势。
通过上述对比仿真实验可以得出结论:使用本发明IAPF-A*算法的路径规划效率明显优于传统A*算法。且使用本发明提出的IAPF-A*算法比传统A*算法和他人改进的A*算法效果好、速度快,这说明了本发明提出的IAPF-A*算法在路径优化方面的可行性与实用性。
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制;任何熟悉本领域的技术人员,在不脱离本发明技术方案范围情况下,都可利用上述揭示的方法和技术内容对本发明技术方案做出许多可能的变动和修饰,或修改为等同变化的等效实施例。因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所做的任何简单修改、等同替换、等效变化及修饰,均仍属于本发明技术方案保护的范围内。
Claims (1)
1.一种基于IAPF-A*融合算法的机器人路径规划,包括以下步骤:
S1、初始化算法的相关参数,包括:地图数据m、起点S、终点E、空列表A、list_del、list_append、open、close,势场变化系数k=1.1;
S2、根据传统人工势场法APF相关公式(3)、(4)、(5)计算每个节点的势力场pf;
pf=pfatt+pfrep (3)
其中,pfatt与pfrep分别是引力场与斥力场,ζ与η分别是引力、斥力的权重因子,d与D分别为机器人与终点、障碍物的欧氏距离,Q为障碍物的影响半径;
S3、将所有障碍物的邻接节点添加进列表A;
S4、开始循环;
S5、令势场变化总量delta=0;
S6、依次遍历列列表A中的节点,记为节点a,执行S7;遍历结束后执行S13;
S7、检测节点a的邻接节点的势能的最小值,记min(pfa);
S8、若min(pfa)<节点a的势能pf,则执行S9;否则,执行S10;
S9、将节点a添加进list_del,执行S12;
S10、根据式(1)计算节点的新势能pf',并令delta自增势能的前后变化的绝对值;
式中,pfa为邻接节点的势力场,k为势场变化系数,min()为获取最小值函数;
S11、将节点a的邻接节点添加仅list_append;
S12、将list_append中的节点添加进列表A;将list_del中的节点从列表A中删除;执行S6;
S13、若delta为0,则退出势场修正的迭代过程,执行S14;否则执行S5;
S14、根据式(2)计算初始节点的评价指标F,并将节点信息放入到open列表中;
F=G+pf' (2);
S15、选出open列表中F值最小的节点,若该节点是终点,则执行S18,否则执行S16;
S16、由式(2)计算该节点的邻接节点的F值,并加入open列表中;
S17、最后将该节点添加进close列表,执行S15;
S18,由该节点开始,依次查找父节点,直到找到起点,输出遍历过程的节点,即为最短路径。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211408188.4A CN115686020B (zh) | 2022-11-10 | 2022-11-10 | 一种基于iapf-a*融合算法的机器人路径规划 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211408188.4A CN115686020B (zh) | 2022-11-10 | 2022-11-10 | 一种基于iapf-a*融合算法的机器人路径规划 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115686020A CN115686020A (zh) | 2023-02-03 |
CN115686020B true CN115686020B (zh) | 2024-04-26 |
Family
ID=85051200
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211408188.4A Active CN115686020B (zh) | 2022-11-10 | 2022-11-10 | 一种基于iapf-a*融合算法的机器人路径规划 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115686020B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116059424B (zh) * | 2023-03-06 | 2023-06-16 | 合肥泷睿机器人有限责任公司 | 一种移动式病毒消杀机器人用导航定位消杀系统 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20090030683A (ko) * | 2007-09-20 | 2009-03-25 | 한국과학기술연구원 | 로봇의 경로 설계 방법 및 그 로봇 |
WO2017173990A1 (zh) * | 2016-04-07 | 2017-10-12 | 北京进化者机器人科技有限公司 | 一种机器人避障中的最短路径规划方法 |
CN110928295A (zh) * | 2019-10-16 | 2020-03-27 | 重庆邮电大学 | 一种融合人工势场与对数蚁群算法的机器人路径规划方法 |
CN111897328A (zh) * | 2020-07-17 | 2020-11-06 | 武汉理工大学 | 一种基于改进人工势场法的路径规划方法、装置及设备 |
CN112577491A (zh) * | 2020-12-14 | 2021-03-30 | 上海应用技术大学 | 一种基于改进人工势场法的机器人路径规划方法 |
CN112965471A (zh) * | 2021-02-10 | 2021-06-15 | 大连理工大学 | 一种考虑角速度约束和改进斥力场的人工势场路径规划方法 |
CN114166235A (zh) * | 2021-12-06 | 2022-03-11 | 福建工程学院 | 一种基于优化a-star算法的全局动态平滑路径规划方法 |
CN114326726A (zh) * | 2021-12-24 | 2022-04-12 | 杭州电子科技大学 | 一种基于a*与改进人工势场法的编队路径规划控制方法 |
CN114489040A (zh) * | 2021-12-13 | 2022-05-13 | 中煤科工集团信息技术有限公司 | 基于改进a*算法与人工势场算法的混合路径规划方法 |
-
2022
- 2022-11-10 CN CN202211408188.4A patent/CN115686020B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20090030683A (ko) * | 2007-09-20 | 2009-03-25 | 한국과학기술연구원 | 로봇의 경로 설계 방법 및 그 로봇 |
WO2017173990A1 (zh) * | 2016-04-07 | 2017-10-12 | 北京进化者机器人科技有限公司 | 一种机器人避障中的最短路径规划方法 |
CN110928295A (zh) * | 2019-10-16 | 2020-03-27 | 重庆邮电大学 | 一种融合人工势场与对数蚁群算法的机器人路径规划方法 |
CN111897328A (zh) * | 2020-07-17 | 2020-11-06 | 武汉理工大学 | 一种基于改进人工势场法的路径规划方法、装置及设备 |
CN112577491A (zh) * | 2020-12-14 | 2021-03-30 | 上海应用技术大学 | 一种基于改进人工势场法的机器人路径规划方法 |
CN112965471A (zh) * | 2021-02-10 | 2021-06-15 | 大连理工大学 | 一种考虑角速度约束和改进斥力场的人工势场路径规划方法 |
CN114166235A (zh) * | 2021-12-06 | 2022-03-11 | 福建工程学院 | 一种基于优化a-star算法的全局动态平滑路径规划方法 |
CN114489040A (zh) * | 2021-12-13 | 2022-05-13 | 中煤科工集团信息技术有限公司 | 基于改进a*算法与人工势场算法的混合路径规划方法 |
CN114326726A (zh) * | 2021-12-24 | 2022-04-12 | 杭州电子科技大学 | 一种基于a*与改进人工势场法的编队路径规划控制方法 |
Non-Patent Citations (5)
Title |
---|
obstacle avoidance path planning for apple picking robotic arm incorporating artificial potential field and A* Algorithm;MIN ZHUANG;IEEE Access;20230907;第11卷(第 期);全文 * |
基于IAPF与多层Morphin搜索树的移动机器人路径规划;王伟;陈跃东;陈孟元;;电子测量与仪器学报;20170215(02);全文 * |
基于改进人工势场法的 AUV全局路径规划;王磊;河南理工大学学报 (自然科学版);20240131;第43卷(第1期);全文 * |
基于改进智能优化算法的机器人路径规划研究;李东东;CNKI硕士学位论文电子期刊;20231231;全文 * |
移动机器人避障路径规划改进人工势场法;姚靖靖;科学技术与工程;20110331;第11卷(第13期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN115686020A (zh) | 2023-02-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111504325B (zh) | 一种基于扩大搜索邻域的加权a*算法的全局路径规划方法 | |
CN110928295B (zh) | 一种融合人工势场与对数蚁群算法的机器人路径规划方法 | |
CN112327876B (zh) | 一种基于终距指数的机器人路径规划方法 | |
CN110160546B (zh) | 一种移动机器人路径规划方法 | |
CN110794832B (zh) | 一种基于强化学习的移动机器人路径规划方法 | |
CN109116841B (zh) | 一种基于蚁群算法的路径规划平滑优化方法 | |
CN107943053A (zh) | 一种移动机器人的路径规划方法 | |
CN108775902A (zh) | 基于障碍物虚拟膨胀的伴随机器人路径规划方法及系统 | |
CN115686020B (zh) | 一种基于iapf-a*融合算法的机器人路径规划 | |
CN108444490B (zh) | 基于可视图和a*算法深度融合的机器人路径规划方法 | |
CN105527964A (zh) | 一种机器人路径规划方法 | |
CN113515129B (zh) | 一种基于边界查找的双向跳点搜索无人车路径规划方法 | |
CN109491389A (zh) | 一种具有速度约束的机器人轨迹跟踪方法 | |
CN110909961B (zh) | 基于bim的室内路径查询方法及装置 | |
CN110207706A (zh) | 一种基于栅格地图的自动归位椅路径规划算法 | |
CN115562265B (zh) | 一种基于改进a*算法的移动机器人路径规划方法 | |
CN105512344A (zh) | 一种室内移动对象相对位置的查询方法 | |
CN114675649A (zh) | 一种融合改进的a*与dwa算法的室内移动机器人路径规划方法 | |
CN114166235A (zh) | 一种基于优化a-star算法的全局动态平滑路径规划方法 | |
Yang et al. | Mobile robot path planning based on enhanced dynamic window approach and improved A∗ algorithm | |
CN114326726B (zh) | 一种基于a*与改进人工势场法的编队路径规划控制方法 | |
Li et al. | Path Planning of robots based on an improved A-star algorithm | |
CN114578828A (zh) | 一种基于空间约束a星算法的移动机器人路径规划方法 | |
CN112857384B (zh) | 基于改进启发函数的a*算法的移动机器人路径规划方法 | |
CN112539751A (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 |