面向动态不确定场景的自动驾驶车辆时空耦合分层轨迹规划研究

doi:10.3901/JME.2024.10.222

机械工程学报 ›› 2024, Vol. 60 ›› Issue (10): 222-234.doi: 10.3901/JME.2024.10.222

扫码分享

面向动态不确定场景的自动驾驶车辆时空耦合分层轨迹规划研究

周洪龙¹, 裴晓飞¹, 刘一平¹, 赵柯帆²

1. 现代汽车零部件技术湖北省重点实验室武汉 430070;
2. 汽车零部件技术湖北省协同创新中心武汉 430070

收稿日期:2023-11-28 修回日期:2024-03-14 出版日期:2024-05-20 发布日期:2024-07-24
作者简介:周洪龙,男,2002年出生。主要研究方向为智能汽车轨迹规划与控制。
E-mail:zhouhl@whut.edu.cn
裴晓飞(通信作者),男,1985年出生,博士,副教授,博士研究生导师。主要研究方向为智能网联汽车,汽车动力学与控制。
E-mail:peixiaofei7@whut.edu.cn
基金资助:
国家自然科学基金(52272426)和广西科技重大专项(桂科AA22068094)资助项目。

Study on Spatio-temporal Coupled Hierarchical Trajectory Planning of Autonomous Vehicles for Dynamic Uncertain Scenarios

ZHOU Honglong¹, PEI Xiaofei¹, LIU Yiping¹, ZHAO Kefan²

1. Hubei Key Laboratory of Advanced Technology of Automotive Components, Wuhan 430070;
2. Hubei Collaborative Innovation Center of Automotive Components Technology, Wuhan 430070

Received:2023-11-28 Revised:2024-03-14 Online:2024-05-20 Published:2024-07-24

摘要/Abstract

摘要： 针对智能车辆在结构化道路上，处理动态复杂场景能力较弱以及实时性差的问题，基于可达集的方法设计一种分层式时空耦合的轨迹规划方法，完成车辆在动态不确定场景下的轨迹规划。首先，根据自车与周围的障碍物状态信息，预测障碍物在未来一段时间内的位置分布概率，基于可达集的方法计算各时刻的可达区域，得到最优行驶走廊及一条初始轨迹。其次，利用二次规划的方法在最优行驶走廊内根据初始轨迹进行优化，求解出一条平滑轨迹，并对该轨迹进行跟踪行驶。最后，利用PreScan、CarSim和Matlab软件搭建仿真平台，在动态复杂交通场景下进行仿真分析，并在实车平台上进行避障测试。结果表明，所设计的规划方法能够有效处理动态不确定场景，在保证安全性的前提下能够规划出高效的通行轨迹，同时也能兼顾预测准确度与实时性。

关键词: 自动驾驶, 轨迹预测, 可达集, 轨迹规划

Abstract: In order to solve the problem of weak ability of intelligent vehicles to handle dynamic complex scenes and poor real-time performance on structured roads, a hierarchical spatio-temporal coupled trajectory planning method is designed based on the reachable set method to complete the vehicle’s dynamic uncertainty scenarios trajectory planning. Firstly, based on the status information of the vehicle and surrounding obstacles, the location distribution probability of obstacles in the future is predicted, and the reachable area at each time is calculated based on the reachable set method, and the optimal driving corridor and an initial trajectory are obtained. Secondly, the quadratic programming method is used to optimize the initial trajectory within the optimal driving corridor, and a smooth trajectory is obtained, and the trajectory is tracked. Finally, a simulation platform is built using PreScan, CarSim and Matlab software, simulation analysis is conducted under dynamic and complex traffic scenarios, and obstacle avoidance testing is conducted on the real vehicle platform. The results show that the designed planning method can effectively handle dynamic uncertain scenarios, plan efficient traffic trajectories while ensuring safety, and can also take into account prediction accuracy and real-time performance.

Key words: autonomous driving, trajectory prediction, reachable set, trajectory planning

中图分类号:

U467

周洪龙, 裴晓飞, 刘一平, 赵柯帆. 面向动态不确定场景的自动驾驶车辆时空耦合分层轨迹规划研究[J]. 机械工程学报, 2024, 60(10): 222-234.

ZHOU Honglong, PEI Xiaofei, LIU Yiping, ZHAO Kefan. Study on Spatio-temporal Coupled Hierarchical Trajectory Planning of Autonomous Vehicles for Dynamic Uncertain Scenarios[J]. Journal of Mechanical Engineering, 2024, 60(10): 222-234.

参考文献

[1] 刘梓林，黎予生，郑玲. 基于非结构化环境点云稀疏表示的无人驾驶汽车局部路径规划方法[J]. 机械工程学报，2020，56(2):163-173. LIU Zilin，LI Yusheng，ZHENG Ling. Local path planning for autonomous vehicles based on sparse representation of point cloud in unstructured environments[J]. Journal of Mechanical Engineering，2020，56(2):163-173.
[2] 彭晓燕，谢浩，黄晶. 无人驾驶汽车局部路径规划算法研究[J]. 汽车工程，2020，42(1):1-10. PENG Xiaoyan，XIE Hao，HUANG Jing. Research on local path planning algorithm for unmanned vehicles[J]. Automotive Engineering，2020，42(1):1-10.
[3] YANG B，YAN S，WANG Z，et al. Prediction based trajectory planning for safe interactions between autonomous vehicles and moving pedestrians in shared spaces[J]. IEEE Transactions on Intelligent Transportation Systems，2023，24(10):10513-10524.
[4] ZHANG X，WANG B，LU Y，et al. A hierarchical multi-vehicle coordinated motion planning method based on interactive spatio-temporal corridors[J]. IEEE Transactions on Intelligent Vehicles，2023，9(1):2675-2687.
[5] BRANNSTROM M，COELINGH E，SJOBERG J. Model-based threat assessment for avoiding arbitrary vehicle collisions[J]. IEEE Transactions on Intelligent Transportation Systems，2010，11(3):658-669.
[6] KIM H，KIM G，PARK J，et al. Action conditioned response prediction with uncertainty for automated vehicles[C]//2019 International Symposium on Intelligent Signal Processing and Communication Systems (ISPACS)，Taipei，Taiwan:IEEE，2019:1-2.
[7] ALTCHE F，DE LA FORTELLE A. An LSTM network for highway trajectory prediction[C]//2017 IEEE 20th International Conference on Intelligent Transportation Systems (ITSC). New York:IEEE，2017:353-359.
[8] GONZALEZ D，PEREZ J，MILANES V，et al. A review of motion planning techniques for automated vehicles[J]. IEEE Transactions on Intelligent Transportation Systems，2015，17(4):1135-1145.
[9] WANG Z，ZLANTANOVA S，OOSTEROM P V. Path planning for first responders in the presence of moving obstacles with uncertain boundaries[J]. IEEE Transactions on Intelligent Transportation Systems，2017，18(8):2163-2173.
[10] 张家旭，王欣志，赵健，等. 汽车高速换道避让路径规划及离散滑模跟踪控制[J]. 吉林大学学报(工学版)，2021，51(3):1081-1090. ZHANG Jiaxu，WANG Xinzhi，ZHAO Jian，et al. Path planning and discrete sliding mode tracking control for high⁃speed lane changing collision avoidance of vehicle[J]. Journal of Jilin University (Engineering and Technology Edition)，2021，51(3):1081-1090.
[11] PATRICK S，THEODOR M H，MAXIMILIAN K，et al. Sequential convex programming methods for real-time optimal trajectory planning in autonomous vehicle racing[J]. IEEE Transactions on Intelligent Vehicles，2023，8(1):661-672.
[12] XIN L，KONG Y，LI S E，et al. Enable faster and smoother spatio-temporal trajectory planning for autonomous vehicles in constrained dynamic environment[J]. Proceedings of the Institution of Mechanical Engineers，Part D:Journal of Automobile Engineering，2021，235(4):1101-1112.
[13] MAHDI M，ERIK F，JAN A. Spatio-temporal planning in multi-vehicle scenarios for autonomous vehicle using support vector machines[J]. IEEE Transactions on Intelligent Vehicles，2021，6(4):611-621.
[14] MANZINGER S，PEK C，ALTHOFF M. Using reachable sets for trajectory planning of automated vehicles[J]. IEEE Transactions on Intelligent Vehicles，2021，6(2):232-248.
[15] SONTGES S，ALTHOFF M. Computing the drivable area of autonomous road vehicles in dynamic road scenes[J]. IEEE Transactions on Intelligent Transportation Systems，2018，19(6):1855-1866.
[16] 周兴珍，裴晓飞，张鑫康. 基于可达集优化的智能汽车轨迹规划研究[J]. 武汉理工大学学报，2022，44(6):39-48. ZHOU Xingzhen，PEI Xiaofei，ZHANG Xinkang. Trajectory planning of intelligent vehicle based on reachable set and optimization[J]. Journal of Wuhan University of Technology，2022，44(6):39-48.
[17] ZHANG Y，SUN H，ZHOU J，et al. Optimal vehicle path planning using quadratic optimization for baidu apollo open platform[C]//2020 IEEE Intelligent Vehicles Symposium (IV). Las Vegas:IEEE，2020:978-984.

面向动态不确定场景的自动驾驶车辆时空耦合分层轨迹规划研究

Study on Spatio-temporal Coupled Hierarchical Trajectory Planning of Autonomous Vehicles for Dynamic Uncertain Scenarios

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	申世全, 任锟, 李永国, 韩蕴生, 项琬婷, 耿赫阳. 金属表面异形区域上色轨迹自动规划[J]. 机械工程学报, 2024, 60(7): 258-265.
[2]	周晨, 徐飞翔. 四轮独立转向车辆转向模式切换轨迹多目标优化方法研究[J]. 机械工程学报, 2024, 60(6): 306-320.
[3]	张鹏, 尹来容, 仝永刚, 黄龙. 基于间隙预测模型的自动铺带轨迹优化方法[J]. 机械工程学报, 2024, 60(5): 296-316.
[4]	张志勇, 王宇翔, 黄彩霞, 吴悠, 杜荣华. 融合灰色预测和卡尔曼滤波的车辆侧向碰撞预警[J]. 机械工程学报, 2024, 60(20): 240-250.
[5]	梁亮, 吴成东, 刘世昌. 基于关节损耗约束的工业机器人最优轨迹规划算法研究[J]. 机械工程学报, 2024, 60(19): 11-19.
[6]	褚端峰, 刘鸿祥, 高博麟, 王金湘, 殷国栋. 车辆队列预测巡航控制研究综述[J]. 机械工程学报, 2024, 60(18): 218-246.
[7]	王洪亮, 雍健羽, 皮大伟, 谢伯元, 王尔烈, 王显会. 基于贝塞尔曲线和多目标优化方法的多车队形切换轨迹规划[J]. 机械工程学报, 2024, 60(16): 270-279.
[8]	隗寒冰, 吴化腾, 徐进. 考虑驾驶员NMS特征的自动驾驶汽车人机共驾鲁棒横向控制[J]. 机械工程学报, 2024, 60(16): 280-290.
[9]	胡俊宇, 韩旭, 陶友瑞, 李珊瑚, 张建宁. 一种考虑跟随误差的S形轨迹残余振动抑制可靠性分析方法[J]. 机械工程学报, 2024, 60(16): 390-399.
[10]	李玖法, 邹博文, 任玥. 考虑车-路交互作用的车辆轨迹预测算法研究[J]. 机械工程学报, 2024, 60(10): 76-85.
[11]	高镇海, 于桐, 孙天骏. 考虑社会性行为的自动驾驶运动规划研究综述[J]. 机械工程学报, 2024, 60(10): 112-128.
[12]	戢杨杰, 张馨雨, 杨紫茹, 周上航, 黄岩军, 曹建永, 熊璐, 余卓平. 多智能网联汽车轨迹规划：现状与展望[J]. 机械工程学报, 2024, 60(10): 129-146.
[13]	褚端峰, 彭赛骞, 胡海洋, 皮大伟. 预见性驾驶风险场模型[J]. 机械工程学报, 2024, 60(10): 160-170.
[14]	梁凯冲, 赵治国, 颜丹姝, 赵坤. 基于动态运动基元的车辆高速公路换道轨迹规划[J]. 机械工程学报, 2024, 60(10): 192-206.
[15]	曾迪, 郑玲, 李以农, 杨显通. 自动驾驶奖励函数贝叶斯逆强化学习方法[J]. 机械工程学报, 2024, 60(10): 245-260.