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

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.

导出引用管理器 EndNote|Reference Manager|ProCite|BibTeX|RefWorks

链接本文: http://www.cjmenet.com.cn/CN/10.3901/JME.2024.10.222

http://www.cjmenet.com.cn/CN/Y2024/V60/I10/222

参考文献

[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]	滕景佳, 李洋, 胡满江, 熊善程, 李国法. 基于场景复杂度分类网络与引导点机制的4WIS车辆轨迹规划方法研究[J]. 机械工程学报, 2026, 62(8): 432-449.
[2]	肖跃, 贺宜, 张鸣. 基于分层式MPC的分布式四轮驱动车辆轨迹跟踪控制方法[J]. 机械工程学报, 2026, 62(8): 475-488.
[3]	马建伟, 李冠霖, 谢英豪, 申原同, 贾振元. 复杂曲面车削刀具轨迹轮廓偏差一致性控制方法[J]. 机械工程学报, 2026, 62(7): 452-461.
[4]	唐小林, 张焜埸, 陈止戈, 杨剑英, 杨为. 融合交互预测信息的自动驾驶安全规划方法研究[J]. 机械工程学报, 2026, 62(4): 249-262.
[5]	龙秀华, 胡正国, 付涛, 连楷研, 宋学官. 基于非对称多段S型曲线的矿用电铲轨迹优化[J]. 机械工程学报, 2025, 61(5): 263-274.
[6]	陈其怀, 林添良, 马荣华, 温建和, 缪骋, 任好玲. 基于多模态的履带式挖掘机自动驾驶决策网络[J]. 机械工程学报, 2025, 61(4): 380-388.
[7]	姚福星, 李浩宇, 冷江昊, 杨雄基, 孙超. 面向多场景高速公路的多专家学习自主换道决策方法[J]. 机械工程学报, 2025, 61(22): 198-210.
[8]	王国栋, 刘立, 孟宇, 白国星, 王家轩, 顾青. 融合摩擦因数估计的自动驾驶汽车集成路径跟踪控制[J]. 机械工程学报, 2025, 61(20): 243-252.
[9]	陈特, 蔡英凤, 陈龙, 徐兴. 基于四阶贝塞尔曲线的应急救援车辆轨迹规划方法[J]. 机械工程学报, 2025, 61(2): 198-209.
[10]	柳献, 胡秋斌, 朱雁飞, 翟一欣, 黄德中. 盾构管片自动拼装技术研究现状与展望[J]. 机械工程学报, 2025, 61(19): 183-201.
[11]	陈翔, 侯凯龙, 赵万忠, 王春燕. 考虑驾驶员特性的商用车电液复合转向系统自动驾驶转向模式切换控制[J]. 机械工程学报, 2025, 61(12): 204-216.
[12]	陆天尧, 尉凌霄, 曹珍珍, 刘钢, 茅健, 李军利. 锥壳展开面的自动铺丝轨迹规划优化算法[J]. 机械工程学报, 2025, 61(11): 406-416.
[13]	贺宜, 杜宇豪, 吴钪, 邱志军. 基于层次迭代搜索的自动驾驶重载半挂牵引车轨迹规划方法[J]. 机械工程学报, 2025, 61(10): 335-348.
[14]	申世全, 任锟, 李永国, 韩蕴生, 项琬婷, 耿赫阳. 金属表面异形区域上色轨迹自动规划[J]. 机械工程学报, 2024, 60(7): 258-265.
[15]	周晨, 徐飞翔. 四轮独立转向车辆转向模式切换轨迹多目标优化方法研究[J]. 机械工程学报, 2024, 60(6): 306-320.