汽车文摘

算法名称	优点	缺点
概率路线图	精度较高、具有概率完备性	时间长、动态规划能力较差
快速探索随机树	速度快、灵活性高	稳定性较差

算法名称	优点	缺点
概率路线图	精度较高、具有概率完备性	时间长、动态规划能力较差
快速探索随机树	速度快、灵活性高	稳定性较差

自动驾驶汽车避障运动中路径规划研究综述

PDF下载

明瑞阳

汽车文摘 | 2023,(7): 40-45

收起

汽车文摘 | 2023, (7): 40-45

自动驾驶汽车避障运动中路径规划研究综述

全屏

明瑞阳

作者信息

重庆交通大学机电与车辆工程学院，重庆 400074

明瑞阳，男，重庆交通大学机电与车辆工程学院在读，研究方向为车辆控制与感知。E-mail: 961841597@qq.com

A Review of Research on Obstacle Avoidance Motion Process for Automated Driving Vehicles

Ruiyang Ming

Affiliations

School of Electrical, Mechanical and Vehicle Engineering,Chongqing Jiaotong University, Chongqing 400074

出版时间: 2023-07-05 doi: 10.19822/j.cnki.1671-6329.20230065

文章导航

摘要

收起

随着车辆自动化程度的提高，车辆自主进行避障功能需求日益增加。因此，准确安全合理地规划出避障路线成为自动驾驶汽车的一个重要研究方向。阐述了当前局部路径规划算法研究现状，以及这些算法在实际应用中存在的局限性。同时，针对这些局限性，综述了目前采用改进的基于人工势场法和采样法路径规划算法研究现状。结果表明，这种改进的路径规划算法在试验或实际应用中表现较好，未来多算法融合路径规划效果优于单算法路径规划。

关键词

自动驾驶 / 避障 / 轨迹规划

Abstract

收起

With the increasing level of vehicle automation, there is a growing demand for vehicles to autonomously perform obstacle avoidance in the field of autonomous driving. Therefore, to accurately, safely, and reasonably plan obstacle avoidance routes has become an important research direction in the field of automated driving. This paper elaborates the current research status of local path planning algorithms and their limitations in practical applications. Furthermore, the research status of improved path planning algorithms based on artificial potential field and sampling methods are reviewed in response to these limitations. The results show that this improved path planning algorithm performs well in experiments or practical applications and the path planning effect of multi-algorithm fusion is better than that of single algorithm in the future.

Key words

Automated driving / Obstacle avoidance / Trajectory planning

引用本文

明瑞阳. 自动驾驶汽车避障运动中路径规划研究综述. 汽车文摘, 2023 , (7) : 40 -45 . DOI: 10.19822/j.cnki.1671-6329.20230065

Ruiyang Ming. A Review of Research on Obstacle Avoidance Motion Process for Automated Driving Vehicles[J]. Automotive Digest, 2023 , (7) : 40 -45 . DOI: 10.19822/j.cnki.1671-6329.20230065

正文

收起

0 引言

收起

随着汽车产业市场规模的不断扩大，汽车产业在加速向智能化、网联化、电动化和共享化转型。2021年8月发布的GB/T 40429—2021《汽车驾驶自动化分级》^[1]将驾驶自动化从0级至5级分为6级，其中以5级为最高自动驾驶等级。

据行业报告显示^[2]，在2020年中国自动驾驶汽车行业的市场规模约为81.32亿元，较上年的84.2亿元同比下降了约3.5%，到2021年增长至94.1亿元左右，同比增长了约15.72%。在我国自动驾驶方面政策、技术发展和市场需求增长多方面带动下，预测未来几年自动驾驶汽车的市场规模将会持续增长，到2023年有望达到约120.5亿元。

在自动驾驶汽车发展中，由于避障功能与车辆安全具有高度耦合性，因此在向高等级自动驾驶发展的过程中，避障功能始终是汽车企业、大学和研究机构重点研发的自动驾驶功能之一。

整个避障运动分为4个动作，包括信息感知、智能决策、路径规划和运动控制^[3]，通过这4个动作使车辆完成躲避障碍物或制动动作。在制动过程中，如何规划出一条合理且安全的轨迹尤为重要。避障路径规划也被称为局部路径规划，与全局路径规划相比，只对当前场景进行路径规划且能够适应不可预见的障碍物。目前，局部路径规划的主要方法包括基于采样的规划方法、人工势场算法、蝼蚁算法和神经网络算法^[4]。

本文对基于采样和人工势场的路径规划算法进行综述，分析对比这2种算法的优缺点，并对近年来国内外研究人员对这两种路径规划算法进行的优化融合进行了归纳，为后续研究人员开展自动驾驶轨迹规划研究与开发提供参考。

1 基于采样的规划方法

收起

目前，基于采样的规划方法可以避免配置空间的离散化和显式表示，从而可以很好地扩展到高维空间。概率路线图（Probabilistic Road Maps,PRM）^[5]和快速探索随机树算法（Rapidly-Exploring Random Tree,RRT）^[6]是基于采样法进行路径规划的代表性方法。

1.1 概率路线图算法

基于概率路线图算法解决路径规划问题是在给定的环境中设置多个点位，除去被设置在障碍物上的点位外，对剩余点位进行算法运算，从而得出一条规避障碍物的路线，如图1~图3所示。

如图3所示，在所规划的路段中，虽然所有点位均不在障碍物上，但2点之间的路线仍会经过障碍物，如灰色路线，因此碰撞检测耗时较长，导致规划效率较低。

1.2 快速探索随机树算法

与概率路线图算法不同，快速探索随机树算法是1种递增式的构造方法。在整个路径规划过程中，仅随机生成1个点位，如果该点位处于无碰撞点位，则寻找探索树种离该点最近的节点作为基准节点，从该基准节点以固定步长向随机点位延伸，每段延伸线的终点会被当作有效节点加入搜索树种。该过程一直持续到目标节点与搜索树的距离小于最初设定的数值，然后寻找1条连接起点和终点的最短路径。该算法有一些不足之处，如搜索时间差异大，在狭窄的通道情况下性能差，离最优路径远。

1.3 算法改进

为了解决概率路线图算法中采样点过多导致运算速度过慢的问题，Mika等^[7]提出了1种基于邻域的方法，通过滤掉不必要的节点来减小路线图的大小。Kumar等^[8]提出了1种减少节点的概率路线图算法来减小路线图大小，通过附近障碍物和目标的距离误差以及高斯成本函数来消除部分节点，以提高规划效率。

而对于快速探索随机树算法而言，尽管改善后的RRT*^[9]能够通过引入近邻搜索和随机树重新布线操作来实现渐近最优，但因为随机抽样机制会影响收敛速度，因此收敛到最优解需要大量时间。Noreen等^[10]提出了1种基于RRT*的RRT*—可调整边界（RRT*—AB）离线规划算法，该算法包括3步策略：即连接区域、基于目标的有界采样和路径优化。基于目标的有界抽样在连接区域的边界内进行，以寻找初始路径，而连接区域可在复杂的环境中扩展，一旦找到路径，就使用节点剔除和集中的有界抽样对其进行逐步优化，最后的路径通过全局修剪进一步改进，以消除多余节点。为了提高该算法路径规划效率，除了剔除不需要的节点外，较为主流的方式是将其它原理或算法和快速探索随机树算法进行融合，以解决规划效率和路线质量问题。

Jeong等^[11]将三角不等式与RRT*相结合提出了Quick-RRT*（Q-RRT*）,其扩大了父顶点集合，产生路径成本比RRT*算法低且能更快收敛到最优。Zhuge等^[12]在Q-RRT*基础上，将启发式信息与Q-RRT*算法优化能力相结合，提出1种基于虚拟光的Q-RRT*（LQRRT*）,该算法相比于Q-RRT*算法优化了采样空间，提高了采样效率且试验证明了内存占用量较少。

Wu等^[13]提出了1种基于RRT的路径搜索算法Fast-RRT，该算法由1个改进RRT模块和快速最优选择模块融合，前者稳定获取1条初始路径，后者将多条初始路径进行合并获得近似最优路径。最终通过试验得出，在相同环境下Fast-RRT算法会比RRT*算法有着更快的速度和更高的稳定性。Wang等^[14]为了解决狭窄空间路径规划问题，提出了1种自适应扩展双向RRT*（AEB-RRT*）算法，该算法从设定的起点和终点双向同时进行扩展，并根据碰撞到障碍物次数自适应调整采样频率，将得到的可行路径通过插值和三角不等式原理进行处理，得到更短的可行路径。

为了减少RRT本身的局限性，除上述算法之外，还有基于势场的P-RRT*、结合基于势函数的RRT*（P-RRT*）和Quick-RRT*的PQ-RRT* ^[15]、将双向人工势场与快速探索随机树星（RRT*）相结合的RRT*-Connect（P-RRT*-Connect）规划算法^[16]等，都有效地减少了RRT*算法本身的局限性。

1.4 小结

概率路线图和快速探索随机树法都是常见的路径规划算法。

通过对上述内容的综述，可将概率路线图算法和快速探索随机数算法的优缺点进行归纳对比，如表1所示。

概率路线图算法优点在于：随着搜索时间的增加，其成功规划路径的概率会快速向1收敛，也证明其具备概率的完备性，且具有较高的精度，可以在较为复杂的环境中规划路径。

概率路线图算法缺点在于：该算法需要在全局地图中建立随机采样点，因此运行时间较长，且不能很好地应对障碍物移动的情况。

快速探索随机树法优点在于：其路径生成速度快，能够在较短的时间内找到1条可行路径，且能够应对环境变化，自适应地规划出合适的路径，灵活性较高。

快速探索随机树法缺点在于：处理复杂环境时，随机树分叉多，使得不稳定性较大。

随着人工智能技术的发展，概率路线图和快速探索随机树法将向高效和智能化发展。这2种算法可以结合深度学习技术，实现更加精准和高效的路径规划。

2 人工势场法

收起

人工势场算法是目前运用较为广泛的局部路径规划算法，其基本思想是将物体在具体环境中的运动，转化为人为抽象势场中的运动，由目标点对物体产生吸引力，由障碍物对物体产生排斥力，使得物体能顺利绕过障碍物到达目标点。其中，物体在抽象势场中的受力情况如图4所示，其中，F_att是目标点对物体的吸引力，F_rep是障碍物对物体的排斥力，F_total是吸引力和排斥力产生的合力。人工势场法优点在于该算法生成的路径平滑、计算量小、执行效率高^[17]，但是同样存在着局部极值点和目标不可达的问题^[18]。

对于障碍物较少的简单场景下，人工势场算法可以较为容易地规划出1条无碰撞的路径以快速到达目标点。但在复杂场景下，存在局部极值点，在吸引力和多个排斥力的反复作用下，物体在多个障碍物间做振荡运动，无法驶出局部极值点，如图5所示。

如图6所示，对于物体进入三面封闭的环境后，由于目标点对物体向上的吸引力和障碍物墙壁对物体向下的排斥力两个方向相反的作用力作用下，使得该场景无法使用人工势场算法完成路径规划，存在目标不可达的问题。

2.1 局部极值点的人工势场算法改进

在狭窄环境下，路径中可能存在极值点使物体发生振荡运动从而难以到达目标点，针对这种问题， Duan等^[19]在基于安全距离模型的人工势场中，对于可能存在局部极值点的道路工况，通过引入第二虚拟目标点，产生第二道目标点吸引力，克服了局部极值点问题。同样，Wang等^[20]通过左转弯势场法使物体在脱离局部极值点附近，若物体已经处于局部极值点时，则通过虚拟目标点法在合适的位置设置虚拟点，并忽略障碍物和初始设置的目标点吸引力的影响，使物体在局部最小点转弯和跳出。

Gu等 ^[21]在传统人工势场算法中，添加了1种可修正的斥力势场函数，并将此改进的人工势场算法与模糊控制算法进行融合，利用该融合势场解决局部极值点问题。Ma等^[22]通过引入随机扰动势能的调节机制，解决了在局部极值点难以移动的问题。Shen等^[23]针对局部极值点导致路径规划失败的问题，将快速探索随机树算法与人工势场法相融合，将快速探索随机树所规划的节点设置为新的目标点，为物体提供吸引力的同时弱化预设目标点作用，并改进障碍物排斥势场功能，确保吸引力的力源可及性，保证物体出现在接近局部极值点附近时，能完成路径规划。

2.2 针对目标点不可达的人工势场算法改进

对于目标不可达问题，尹凤仪等^[24]针对目标点附近人工势场建立了规则，在障碍物周围排斥力势场函数加入距离影响因子，使得物体能够抵达目标。Zhang等^[25]为了解决物体在进入陷阱区域的目标点不可达问题，通过对斥力场函数进行改进并选择1个虚拟目标点，从而使物体逃离陷阱到达目标点，如图7所示。同样，Yang等^[26]通过增加引力解决了目标不可达问题。

Cao等^[27]在人工势场法中引入了调节因子，以解决轨迹规划中目标不可达问题。

2.3 融合人工势场的改进算法

针对不同应用场景，张强等^[28]将全局路径规划算法与局部路径规划算法相结合，提出1种融合安全A*和人工势场的融合算法，在A*算法中的代价函数里添加安全距离，并将A*算法中的部分关键节点设置为人工势场中的目标点提供吸引力，经仿真验证，该方法所规划的路径简短且避障能力较好。

音凌一等^[29]为了解决适用于全局路径规划的灰狼优化算法求解效率低和易陷入局部最优的问题，将灰狼算法全局路径规划的节点设置为人工势场临时目标点，并改进临时目标点为临时边界，进行局部路径规划。最终通过仿真表明，在全局静态环境和局部动态环境下，该融合算法在规划路径时有效性很好。

Wu等^[30]提出了1种将人工势场法和IRRT*算法相结合的融合算法，把人工势场法中的势场引入IRRT*算法中的搜索树扩展阶段，提供搜索树扩展方向指引，提高了IRRT*算法的收敛率和搜索效率。同样，辛鹏等^[31]为了减小快速探索随机树法扩展时的随机性，把扩展方向通过人工势场法进行约束，减少随机树向正确目标点扩展的探索时间。

2.4 小结

人工势场法是基于虚拟势场的路径规划算法，它通过构造人工势场来引导物体在环境中移动，从而实现物体自主避障和路径规划。人工势场法的优势主要包括：算法简单易懂、实时性好，且可以用于包括室内室外、平面地形和复杂地形多种场景。其缺点在于作为1种局部路径规划方法，存在局部极值点问题，当物体陷入极值点后将无法继续前进。且该方法在使用过程中需要设定一系列参数，如障碍物排斥力、目标点吸引力等，这些参数设置需要经验和调试，可能会影响路径规划效果。

未来展望方面，人工势场法作为1种经典的路径规划算法，已经被广泛应用于实际场景中。随着人工智能技术的发展，人工势场法仍然具有重要的应用前景。人工势场法也可以与其它路径规划算法相结合，或者与神经网络技术相结合，形成更加高效和使用便捷的路径规划算法。

3 结束语

收起

避障技术在自动驾驶汽车或者是其他无人设备上来说都是1项核心功能，针对动态或静态环境，合理、高效规划出1条平稳、无碰撞的路径是避障运动能否安全完成的重要核心，本文对3种局部路径规划方法优缺点和目前发展现状进行了综述。

概率路线图法和快速探索随机树法均是基于采样的路径规划方法。概率路线图的优点在于随着搜索时间增加，其成功规划出路径的概率会快速向1收敛，具备概率的完备性。快速探索随机树法的优点在于有更强方向性，且相比于概率路线图流程更加简单。但是这2种规划方法都存在着规划时间较长的问题。而人工势场法优点在于生成的路径平滑、计算量小，同时该方法对传感器的误差有一定的鲁棒性，其缺点在于存在局部极值和目标不可达问题。

在进行路径规划时，研究人员需要根据不同的待规划环境采用不同的路径规划策略。就目前而言，多种算法融合后进行路径规划，往往比单种规划方法所得到的路径规划效果好，同时也可避免一些如探索随机树扩展时间长、人工势场法容易陷入陷阱区域的问题。

参考文献

收起

文献

收起

参考文献引证文献

排序方式：

[1]

全国汽车标准化技术委员会(SAC/TC 114). 汽车驾驶自动化分级: GB/T 40429—2021[S/OL]. (2021-08-20)[2023-06-06]. https://openstd.samr.gov.cn/bzgk/gb/newGbInfo?hcno=4754CB1B7AD798F288C52D916BFECA34. https://openstd.samr.gov.cn/bzgk/gb/newGbInfo?hcno=4754CB1B7AD798F288C52D916BFECA34

[2]

搜狐网. 「市场分析及预测」中国无人驾驶汽车市场现状,政策持续发力,市场规模稳增长[EB/OL]. ( 2022-8-30)[2023-06-25]. http://news.sohu.com/a/581084997_120700738. http://news.sohu.com/a/581084997_120700738

[3]

张宏宏, 甘旭升, 毛亿, 等. 无人机避障算法综述[J]. 航空兵器, 2021, 28(5): 53-63.

[4]

詹玉. 无人驾驶汽车路径规划方法研究[D]. 贵州: 贵州大学, 2022.

[5]

KAVRAKI

L E

, SVESTKA

, LATOMBE

J C

, et al. Probabilistic Roadmaps for Path Planning in High-Dimensional Configuration Spaces[J]. IEEE Transactions on Robotics and Automation, 1996, 12(4): 566-580.

[6]

LAVALLE

S M

. Rapidly-exploring random trees: A new tool for path planning[EB/OL]. (1999-05)[2023-06-06]. https://www.researchgate.net/publication/2639200_Rapidly-Exploring_Random_Trees_A_New_Tool_for_Path_Planning. https://www.researchgate.net/publication/2639200_Rapidly-Exploring_Random_Trees_A_New_Tool_for_Path_Planning

[7]

RANTANEN

M T

, JUHOLA

. How to construct small probabilistic roadmaps with a good coverage?[J]. Advanced Robotics, 2014, 28(22): 1519-1531.

[8]

KUMAR

, SIKANDER

. A modified probabilistic roadmap algorithm for efficient mobile robot path planning[J]. Engineering Optimization. (2022-08-17)[2023-06-06]. https://www.tandfonline.com/doi/abs/10.1080/0305215X.2022.2104840?journalCode=geno20. https://www.tandfonline.com/doi/abs/10.1080/0305215X.2022.2104840?journalCode=geno20

[9]

KARAMAN

, FRAZZOLI

. Sampling-based algorithms for optimal motion planning[J]. The International Journal of Robotics Research, 2011, 30(7): 846-894.

[10]

NOREEN

IRAM

, KHAN

, RYU

, et al. Optimal path planning in cluttered environment using RRT*-AB[J]. Intelligent Service Robotics, 2018, 11(8): 41-52.

[11]

JEONG

I B

, LEE

S J

, KIM

J H

. Quick-RRT*: Triangular Inequality-based Implementation of RRT* with Improved Initial Solution and Convergence Rate[J]. Expert Systems With Applications, 2019, 123(6): 82-90.

[12]

ZHUGE

C C

, WANG

, LIU

J Y

, et al. An Improved Q-RRT* Algorithm Based on Virtual Light[J]. Computer Systems Science and Engineering, 2021, 39(1): 107-119.

[13]

Z P

, MENGZ

, ZHAO

W L

, et al. Fast-RRT: A RRT-Based Optimal Path Finding Method[J]. Applied Sciences, 2021, 11(24): 11777.

[14]

WANG

X W

, WEI

J B

, ZHOU

, et al. AEB-RRT*: an adaptive extension bidirectional RRT* algorithm[J]. Autonomous Robots, 2022, 46(6): 685-704.

[15]

Y J

, WEI

, GAO

, et al. PQ-RRT*: An improved path planning algorithm for mobile robots[J]. Expert Systems With Applications, 2020, 152(8): 113425.

[16]

WANG

X Y

, LI

X J

, YONG

, et al. Bidirectional potential guided RRT* for motion planning[J]. IEEE Access, 2019, 7(7): 95046-95057.

[17]

F F

, ZHAO

H L

, NIE

, et al. Path planning based on improved artificial potential field method[C]// 2021 33rd Chinese Control and Decision Conference (CCDC), IEEE, 2021.

[18]

徐胜, 邢强, 王浩. 解决势场法路径规划中局部极小问题的角度累积法[J]. 控制与决策, 2022, 37(8): 1997-2007.

[19]

DUAN

Y J

, YANG

C B

, ZHU

J H

, et al. Active obstacle avoidance method of autonomous vehicle based on improved artificial potential field[J]. International Journal of Advanced Robotic Systems, 2022, 19(4): 172988062211159.

[20]

WANG

, LI

C L

, GUO

, et al. Local Path Planning of Mobile Robot Based on Artificial Potential Field[C]// 2020 39th Chinese Control Conference (CCC), IEEE, 2020: 254-259.

[21]

, HAN

, ZHANG

, et al. Intelligent vehicle path planning based on improved artificial potential field algorithm[C]//2019 International Conference on High Performance Big Data and Intelligent Systems (HPBD&IS). IEEE, 2019: 104-109.

[22]

, LIN

, SONG

R Y

. Local path planning for unmanned surface vehicle with improved artificial potential field method[J]. Journal of physics. Conference series, 2020, 1634(1): 012125.

[23]

SHEN

, LI

. Unmanned aerial vehicle (UAV) path planning based on improved pre-planning artificial potential field method[C]//2020 Chinese control and decision conference (CCDC). IEEE, 2020: 2727-2732.

[24]

尹凤仪, 刘芳, 吴向阳. 基于改进人工势场法的多无人车编队路径规划[J]. 无人系统技术, 2022, 5(6): 24-30.

[25]

ZHANG

, LI

, WU

. Path Planning based on Improved Artificial Potential Field Method[C]// 2021 33rd Chinese Control and Decision Conference (CCDC), IEEE, 2021.

[26]

YANG

W L

, WU

, ZHOU

X Q

, et al. Improved Artificial Potential Field and Dynamic Window Method for Amphibious Robot Fish Path Planning[J]. Applied Sciences, 2021, 11(5): 1-15.

[27]

CAO

, WANG

, LIU

, et al. 3D trajectory planning based on the Rapidly-exploring Random Tree-Connect and artificial potential fields method for unmanned aerial vehicles[J]. International Journal of Advanced Robotic Systems, 2022, 19(5): 17298806221118867.

[28]

张强, 鲁守银, 张家瑞, 等. 融合安全A-*算法和改进人工势场法的巡检机器人路径规划[J]. 计算机时代, 2022(11): 29-33+37.

[29]

音凌一, 向凤红. 融合改进灰狼优化算法和人工势场法的路径规划[J]. 电子测量技术, 2022, 45(3): 43-53.

[30]

D H

, WEI

L S

, WANG

G L

, et al. APF-IRRT*: An Improved Informed Rapidly-Exploring Random Trees-Star Algorithm by Introducing Artificial Potential Field Method for Mobile Robot Path Planning[J]. Applied Sciences, 2022, 12(21): 10905.

[31]

辛鹏, 王艳辉, 刘晓立, 等. 优化改进RRT和人工势场法的路径规划算法[J]. 计算机集成制造系统, 2023(3): 1-14.

2023年第卷第7期

PDF下载

187

引用本文

BibTeX

文章信息

doi: 10.19822/j.cnki.1671-6329.20230065

首发时间：2026-01-04
出版时间：2023-07-05

补充材料

相关文章

文章信息

作者

出版历史

基金

作者信息

重庆交通大学机电与车辆工程学院，重庆 400074

参考文献

分享链接

https://castjournals.cast.org.cn/joweb/qcwz/CN/10.19822/j.cnki.1671-6329.20230065

分享至

全文二维码

扫描看全文

引用本文

BibTeX

本文的引用情况

2种不同金属材料的力学参数

科 Family	属数 Number of genus	种数 Number of species	占总种数比例 Percentage of total species (%)	属 Genus	种数 Number of species	占总种数比例 Percentage of total species (%)
鹅膏菌科Amanitaceae	2	11	5.26	鹅膏菌属 Amanita	10	4.78
小菇科 Mycenaceae	2	12	5.74	丝盖伞属 Inocybe	5	2.39
多孔菌科 Polyporaceae	8	14	6.70	蜡蘑属 Laccaria	5	2.39
红菇科 Russulaceae	3	23	11.00	小皮伞属 Marasmius	6	2.87
				小菇属 Mycena	11	5.26
				光柄菇属 Pluteus	5	2.39
				红菇属 Russula	17	8.13
				栓菌属 Trametes	5	2.39

关闭全屏

BibTeX
EndNote
RefWorks
TxT