Journal of Automotive Safety and Energy ›› 2025, Vol. 16 ›› Issue (6): 923-933.DOI: 10.3969/j.issn.1674-8484.2025.06.012
• Intelligent Driving and Intelligent Transportation • Previous Articles Next Articles
ZHANG Bingli1(
), ZHANG Zhisen1, ZHANG Yangyang1, LIU An1, XU Yonghua2
Received:2025-06-17
Revised:2025-09-25
Online:2025-12-31
Published:2026-01-12
CLC Number:
ZHANG Bingli, ZHANG Zhisen, ZHANG Yangyang, LIU An, XU Yonghua. BI-RRT* path planning method based on GA optimization and path extension heuristic sampling[J]. Journal of Automotive Safety and Energy, 2025, 16(6): 923-933.
Add to citation manager EndNote|Ris|BibTeX
URL: https://www.journalase.com/EN/10.3969/j.issn.1674-8484.2025.06.012
| Algorithm1: Improved BI-RRT* |
| Require: 起始点Xstart,目标点Xgoal,扩展步长Dstep,连接距离阈值Dthr,偏向概率Pbias等 Return: 可行路径pathbr 1.初始化设置树T1(E1, V1)和T2(E2, V2),将Xstart和Xgoal分别作为两棵树的根节点 2.在地图上按照1.2.1节设置柔性边界,构建改进BI-RRT*算法采样区域 3.选择结构树T1(E1, V1)进行扩展,初始化当前扩展失败次数iternow = 0 4. iternow = iternow + 1,当iternow < itermax时继续步骤5,否则说明树T1(E1, V1)无法扩展,算法终止 5.生成随机概率值Prand,若Prand < Pbias,则选取搜索树T2(E2, V2)根节点作为采样点Xrand,否则在采样区域内随机选取一点作为采样点Xrand 6.根据式结合Xrand,计算得到V1中度量值最优的节点,并将其作为待扩展节点Xparent,向Xrand扩展Dstep距离得到新节点Xnew 7.检测Xnew是否与V1中任一点的距离小于Dthr,或Xnew与Xparent连线是否存在障碍物,若是则返回步骤4,否则对Xnew进行父节点重选和重布线,将Xnew加入V1,并将连接关系存入E1 8.检测Xnew是否与V1中任一点的距离小于Dthr,若是则分别从Xnew和该点按照E1和E2回溯得到路径点集合并存入返回pathbr; 9.交换T1(E1, V1)与T2(E2, V2),返回步骤4。 |
| Algorithm1: Improved BI-RRT* |
| Require: 起始点Xstart,目标点Xgoal,扩展步长Dstep,连接距离阈值Dthr,偏向概率Pbias等 Return: 可行路径pathbr 1.初始化设置树T1(E1, V1)和T2(E2, V2),将Xstart和Xgoal分别作为两棵树的根节点 2.在地图上按照1.2.1节设置柔性边界,构建改进BI-RRT*算法采样区域 3.选择结构树T1(E1, V1)进行扩展,初始化当前扩展失败次数iternow = 0 4. iternow = iternow + 1,当iternow < itermax时继续步骤5,否则说明树T1(E1, V1)无法扩展,算法终止 5.生成随机概率值Prand,若Prand < Pbias,则选取搜索树T2(E2, V2)根节点作为采样点Xrand,否则在采样区域内随机选取一点作为采样点Xrand 6.根据式结合Xrand,计算得到V1中度量值最优的节点,并将其作为待扩展节点Xparent,向Xrand扩展Dstep距离得到新节点Xnew 7.检测Xnew是否与V1中任一点的距离小于Dthr,或Xnew与Xparent连线是否存在障碍物,若是则返回步骤4,否则对Xnew进行父节点重选和重布线,将Xnew加入V1,并将连接关系存入E1 8.检测Xnew是否与V1中任一点的距离小于Dthr,若是则分别从Xnew和该点按照E1和E2回溯得到路径点集合并存入返回pathbr; 9.交换T1(E1, V1)与T2(E2, V2),返回步骤4。 |
| Algorithm2: GEP_BIRRT |
| Require: 可行路径pathbr、种群数量NP、交叉概率pc、最小变异概率pm.min、最大变异概率pm.max等 Return: 优化路径pathopt 1.初始化预先设定的算法参数,对地图每个网格进行坐标与路径点索引转换 2.根据改进BI-RRT*规划得到的可行路径pathbr,按照2.2节所述进行节点扩展,得到优化区域 3.在优化区域内进行种群初始化,得到NP条个体路径组成当前种群 4.综合考虑路径长度、平滑度和碰撞危险度对当前种群每条个体路径Li计算适应度得到Ti 5.按照适应度对当前种群进行锦标赛选择操作,接着以两条个体路径为一组遍历种群,生成随机数prc若小于pc则对该组进行交叉操作,然后根据当前进化次数,对每条路径Li计算得到动态变异概率pm(i, g),生成随机数prm若小于pm(i, g)则对该条路径进行变异操作 6.进化次数增加一次,若进化次数达到最大进化次数Gmax则选取当前适应度最优路径作为pathopt返回,算法终止;否则返回步骤4 |
| Algorithm2: GEP_BIRRT |
| Require: 可行路径pathbr、种群数量NP、交叉概率pc、最小变异概率pm.min、最大变异概率pm.max等 Return: 优化路径pathopt 1.初始化预先设定的算法参数,对地图每个网格进行坐标与路径点索引转换 2.根据改进BI-RRT*规划得到的可行路径pathbr,按照2.2节所述进行节点扩展,得到优化区域 3.在优化区域内进行种群初始化,得到NP条个体路径组成当前种群 4.综合考虑路径长度、平滑度和碰撞危险度对当前种群每条个体路径Li计算适应度得到Ti 5.按照适应度对当前种群进行锦标赛选择操作,接着以两条个体路径为一组遍历种群,生成随机数prc若小于pc则对该组进行交叉操作,然后根据当前进化次数,对每条路径Li计算得到动态变异概率pm(i, g),生成随机数prm若小于pm(i, g)则对该条路径进行变异操作 6.进化次数增加一次,若进化次数达到最大进化次数Gmax则选取当前适应度最优路径作为pathopt返回,算法终止;否则返回步骤4 |
| 实验环境 | 实验算法 | 平均路径长度 | 最优路径长度 | 平均规划时间/ s | 最短用时/ s | 平均总转角/ (°) |
|---|---|---|---|---|---|---|
| 复杂障碍物 | Informed-RRT* | 708.460 | 701.500 | 2.278 | 2.065 | 228.592 |
| BI-RRT* | 711.381 | 702.214 | 1.794 | 1.620 | 317.402 | |
| GEP_BIRRT | 701.074 | 696.673 | 1.857 | 1.573 | 154.147 | |
| 迷宫 | Informed-RRT* | 815.490 | 805.272 | 3.215 | 2.907 | 384.057 |
| BI-RRT* | 820.836 | 804.884 | 1.694 | 1.481 | 421.388 | |
| GEP_BIRRT | 806.318 | 799.392 | 1.806 | 1.442 | 273.355 | |
| 狭窄通道 | Informed-RRT* | 973.051 | 960.308 | 5.492 | 5.087 | 375.659 |
| BI-RRT* | 970.842 | 964.300 | 2.702 | 2.419 | 372.965 | |
| GEP_BIRRT | 958.113 | 953.146 | 1.614 | 1.061 | 238.905 |
| 实验环境 | 实验算法 | 平均路径长度 | 最优路径长度 | 平均规划时间/ s | 最短用时/ s | 平均总转角/ (°) |
|---|---|---|---|---|---|---|
| 复杂障碍物 | Informed-RRT* | 708.460 | 701.500 | 2.278 | 2.065 | 228.592 |
| BI-RRT* | 711.381 | 702.214 | 1.794 | 1.620 | 317.402 | |
| GEP_BIRRT | 701.074 | 696.673 | 1.857 | 1.573 | 154.147 | |
| 迷宫 | Informed-RRT* | 815.490 | 805.272 | 3.215 | 2.907 | 384.057 |
| BI-RRT* | 820.836 | 804.884 | 1.694 | 1.481 | 421.388 | |
| GEP_BIRRT | 806.318 | 799.392 | 1.806 | 1.442 | 273.355 | |
| 狭窄通道 | Informed-RRT* | 973.051 | 960.308 | 5.492 | 5.087 | 375.659 |
| BI-RRT* | 970.842 | 964.300 | 2.702 | 2.419 | 372.965 | |
| GEP_BIRRT | 958.113 | 953.146 | 1.614 | 1.061 | 238.905 |
| [1] | 匡兴红, 沈佳成. 改进北方苍鹰算法及其在智能汽车路径规划中的应用[J]. 汽车安全与节能学报, 2025, 16(1): 148-158. |
| KUANG Xinghong, SHEN Jiacheng. Improvement of the northern eagle algorithm and its application in intelligent vehicle path planning[J]. J Autom Safe Energ, 2025, 16(1): 148-158. (in Chinese) | |
| [2] | 郭丛帅, 刘辉, 聂士达, 等. 考虑复杂地形和障碍尺度的无人车轨迹规划[J]. 汽车工程, 2025, 47(4): 645-657, 668. |
| GUO Congshuai, LIU Hui, NIE Shida, et al. Trajectory planning for autonomous vehicles considering complex terrain and obstacle scales[J]. Autom Engineering, 2025, 47(4): 645-657, 668. (in Chinese) | |
| [3] | 滕磊. 无人驾驶车辆路径规划与轨迹跟踪控制算法的研究[D]. 杭州: 浙江科技大学, 2024. |
| TENG Lei. Research on the path planning and track tracking control algorithm of autonomous driving vehicles[D]. Hangzhou: Zhejiang University of Science and Technology, 2024. (in Chinese) | |
| [4] |
TANG Guang, TANG Congqiang, Claramunt C, et al. Geometric a-star algorithm: an improved a-star algorithm for AGV path planning in a port environment[J]. IEEE Access, 2021, 9: 59196-59210.
doi: 10.1109/ACCESS.2021.3070054 URL |
| [5] | QING Guo, ZHENG Zhang, YUE Xu. Path-planning of automated guided vehicle based on improved Dijkstra algorithm [C]// 2017 29th Chinese Contr Deci Conf (CCDC). Chongqing, China. IEEE, 2017: 7138-7143. |
| [6] | 赵晓鹏, 王国权. 基于改进人工势场法的车辆编队避障研究[J]. 电子测量技术, 2025, 48(18): 13-19. |
| ZHAO Xiaopeng, WANG Guoquan. Research on vehicle formation obstacle avoidance based on improved artificial potential field method[J]. Elect Meas Tech, 2025, 48(18): 13-19. (in Chinese) | |
| [7] |
朱冰, 贾士政, 赵健, 等. 自动驾驶车辆决策与规划研究综述[J]. 中国公路学报, 2024, 37(1): 215-240.
doi: 10.19721/j.cnki.1001-7372.2024.01.018 |
| ZHU Bing, JIA Shizheng, ZHAO Jian, et al. A review of decision-making and planning research on self-driving vehicles[J]. China J Highw Transport, 2024, 37(1): 215-240. (in Chinese) | |
| [8] | Noreen I, Khan A, Habib Z. A comparison of RRT, RRT* and RRT*-smart path planning algorithms[J]. Int’l J Comput Sci Netw Secu (IJCSNS), 2016, 16(10): 20-27. |
| [9] |
王蔡琪, 崔西宁, 熊毅, 等. 基于节点到障碍物距离的自适应扩展RRT*路径规划算法[J]. 计算机应用, 2025, 45(3): 920-927.
doi: 10.11772/j.issn.1001-9081.2024030400 |
|
WANG Caiqi, CUI Xining, XIONG Yi, et al. Adaptive extended RRT* path planning algorithm based on node-to-obstacle distance[J]. J Comput Appl, 2025, 45(3): 920-927. (in Chinese)
doi: 10.11772/j.issn.1001-9081.2024030400 |
|
| [10] | Karaman S, Frazzoli E. Sampling-based algorithms for optimal motion planning[J]. Int’l J Robot Res, 2011, 30(7): 846-894. |
| [11] | CHAI Qisen, WANG Yujun. RJ-RRT: improved RRT for path planning in narrow passages[J]. Appl Sci, 2022, 12(23): 12033-12050. |
| [12] | WANG Binpeng, JU Dianyuan, XU Fangzhou, et al. BI-RRT*: an improved bidirectional RRT* path planner for robot in two-dimensional space[J]. IEEJ Trans Electri Electro Engi, 2023, 18(10): 1639-1652. |
| [13] | 采国顺, 刘昊吉, 冯吉伟, 等. 智能汽车的运动规划与控制研究综述[J]. 汽车安全与节能学报, 2021, 12(3): 279-297. |
| CAI Guoshun, LIU Haoji, FENG Jiwei, et al. Research review on motion planning and control for intelligent vehicles[J]. J Autom Safe Energ, 2021, 12(3): 279-297. (in Chinese) | |
| [14] | 赵学健, 叶昊, 江宇航, 等. 融合改进D*与RRT算法的单AGV路径规划算法[J]. 小型微型计算机系统, 2025, 46(8): 1847-1860. |
| ZHAO Xuejian, YE Hao, JIANG Yuhang, et al. A single AGV path planning algorithm incorporating improved D* and RRT algorithms[J]. J Chin Comput Syst, 2025, 46(8): 1847-1860. (in Chinese) | |
| [15] | 蒋启龙, 许健. 改进PSO-PH-RRT*算法在智能车路径规划中的应用[J]. 东北大学学报(自然科学版), 2025, 46(3): 12-19. |
| JIANG Qilong, XU Jian. Improved PSO-PH-RRT* algorithm in intelligent vehicle path planning[J]. J Northeast Univ (Nat Sci), 2025, 46(3): 12-19. (in Chinese) | |
| [16] |
WANG Wenjuan, LI Jiaye, BAI Zongning, et al. Toward optimization of AGV path planning: an RRT*-ACO algorithm[J]. IEEE Access, 2024, 12: 18387-18399.
doi: 10.1109/ACCESS.2024.3359748 URL |
| [17] | 李忠林, 贾玉婷, 蒋晓丽. 改进遗传算法的移动机器人路径规划研究[J]. 现代信息科技, 2024, 8(23): 180-183, 188. |
| LI Zhonglin, JIA Yuting, JIANG Xiaoli. Research on mobile robot path planning with improved genetic algorithm[J]. Mode Info Tech, 2024, 8(23): 180-183, 188. (in Chinese) | |
| [18] | Lavalle S M, Kuffner J J J. Randomized kinodynamic planning[J]. Int’l J Robot Res, 1999, 15(5): 378-400. |
| [19] | Gammell J D, Srinivasa S S, Barfoot T D, et al. Optimal sampling-based path planning focused via direct sampling of an admissible ellipsoidal heuristic [C]// 2014 IEEE /RSJ Int’l Conf Intel Robot Syst (IROS 2014Chicago, IL, USA. IEEE, 2014: 2997-3004. |
| [20] | Jordan M, Perez A. Optimal bidirectional rapidly-exploring andom trees[R]. Csail MIT, 2013, MIT-CSAIL-TR-2013-021. |
| [21] | CUI Bo, CUI Rongxin, YAN Weisheng, et al. RT-RRT:Reverse tree guided real-time path planning/replanning in unpredictable dynamic environments [C]// 2024 IEEE/RSJ Int’l Conf Intel Robot Syst (IROS). Abu Dhabi, United Arab Emirates. IEEE, 2024: 5380-5387. |
| [1] | WANG Yue, DUAN Hongwei, ZHONG Wei, YANG Lu, HE Lei, CHAI Fulai, SHI Xiaoyang. Path planning method for leader-follower multi-vehicle formation with integrating GoT-SAC [J]. Journal of Automotive Safety and Energy, 2026, 17(1): 122-129. |
| [2] | YANG Zongru, HU Yunze, LIU Shiqi, GUAN Yang, WU Wei, LIU Chang. Distributed active perception path planning for the estimation of parking occupancy status [J]. Journal of Automotive Safety and Energy, 2026, 17(1): 140-148. |
| [3] | PENG Qianlong, JIN bieshu, WANG Jianqiang, WANG Guangwei. Skeleton guided hierarchical autonomous valet parking path planning method with lane constraints [J]. Journal of Automotive Safety and Energy, 2025, 16(5): 784-792. |
| [4] | LI Shunming, WANG Changrong, SHI Wenbei. Progress of mobile charging robot for photovoltaic energy storage and charging [J]. Journal of Automotive Safety and Energy, 2025, 16(4): 505-520. |
| [5] | CHEN Xiaofeng, WANG Lanwen, MA Guo, ZHANG Lei, BAO Jiading, JING Hui. Energy and stability aware path planning for autonomous vehicles in off road environments [J]. Journal of Automotive Safety and Energy, 2025, 16(3): 496-503. |
| [6] | FAN Xiaobin, PENG Jiaxing. Multi-objective torque distribution strategy for hub motor electric vehicles under emergency steering conditions [J]. Journal of Automotive Safety and Energy, 2025, 16(2): 217-225. |
| [7] | KUANG Xinghong, SHEN Jiacheng. Improved Northern Goshawk Optimization Algorithm and its application in intelligent vehicle path planning [J]. Journal of Automotive Safety and Energy, 2025, 16(1): 148-158. |
| [8] | HUANG Zheng, WANG Hongxing, DU Biao, GAO Song, GAO Feng. Intelligent inspection method for power transmission towers, substations, and distribution poles using fixed UAV nests [J]. Journal of Automotive Safety and Energy, 2024, 15(5): 670-679. |
| [9] | HUANG Chen, JIA Dingpeng, SUN Xiaoqiang, XU Qing. Intelligent vehicle path planning method based on peripheral vehicle trajectory prediction [J]. Journal of Automotive Safety and Energy, 2024, 15(5): 753-762. |
| [10] | LI Yulong, XIE Hui, SONG Kang. An obstacle avoidance path planning algorithm for autonomous buses based on tracking error observation and target measurement error observation [J]. Journal of Automotive Safety and Energy, 2024, 15(4): 579-590. |
| [11] | JIN Lisheng, WEI Qingsong, XIE Xianyi, SHI Yewei, LUO Guofeng, LI Keqiang. Multi-vehicle cooperative path planning at untrusted intersections based on DMPC [J]. Journal of Automotive Safety and Energy, 2024, 15(2): 235-241. |
| [12] | MENG Qingjing, SI Junde, ZHANG Xinyu, SUN Honglin, WANG Xiaoyu, RONG Songsong. 3D path planning algorithm for ground and air amphibious platform based on graph search [J]. Journal of Automotive Safety and Energy, 2024, 15(2): 253-260. |
| [13] | HAN Ling, ZHANG Hui, FANG Ruoyu, LIU Guopeng, ZHU Changsheng, CHI Ruifeng. Global path planning strategy based on an improved deep reinforcement learning [J]. Journal of Automotive Safety and Energy, 2023, 14(2): 202-211. |
| [14] | LI Wenli, XIAO Kaiwen, REN Yongpeng, LI Chao, Yi Fan. Path planning and control method for vehicle obstacle avoidance in pedestrian crossing scenes [J]. Journal of Automotive Safety and Energy, 2022, 13(3): 489-501. |
| [15] | LI Yaohua, FAN Jikang, LIU Yang, HE Jie, LI Zetian, PAN Shaofei. Path planning and path tracking control for autonomous vehicle based on MPC with adaptive dual-horizon-parameters [J]. Journal of Automotive Safety and Energy, 2021, 12(4): 528-539. |
| Viewed | ||||||
|
Full text |
|
|||||
|
Abstract |
|
|||||