浏览全部资源
扫码关注微信
纸质出版日期： 2024-11-16 ，
移动端阅览
单云霄， 刘沅昊. 2024. 考虑定位不确定性的无人驾驶安全规划方法. 中国图象图形学报， 29(11):3280-3292
Shan Yunxiao， Liu Yuanhao. 2024. Safety planning method for autonomous driving considering localization uncertainty. Journal of Image and Graphics， 29(11):3280-3292
目的
2
无人驾驶规划与控制是保障行驶安全的重要环节之一，现有的规划方法大多假定驾驶场景是精确感知的，忽略了行驶环境中存在的感知、定位等不确定性。忽略这些不确定性的因素将影响驾驶的安全。本文在考虑传感器数据不确定性的情况下，将系统中实际存在的定位不确定性融入规划系统，从而规划出更加安全的轨迹。
方法
2
通过研究基于栅格地图的不确定环境概率模型框架以及基于该表征框架的轨迹规划方法降低不确定性的影响，产生舒适安全的类人轨迹。该方法首先将先验地图转换为栅格地图作为全局栅格地图，接着结合定位系统将局部栅格地图初始化，然后在局部栅格地图中进行定位不确定性传播，最后在Frenet坐标系进行轨迹规划，使用局部栅格地图的占据概率计算候选轨迹代价，选择最优代价轨迹。
结果
2
本文方法在CARLA（CAR learning to act）仿真器中进行验证，通过仿真实验对比多种方法，验证了本文方法能够在定位不确定性环境下平稳行驶，安全地避开障碍物，在路径安全性和高效性上找到一个平衡点，在多种场景下本文考虑定位不确定性的方法通过率提高15%。
结论
2
本文提出了一种能够融入多种不确定性的环境表征框架，并将定位系统不确定性融入规划方法，实现了规划的安全性和效率的提升。
Objective
2
Autonomous driving planning methods currently assume the certainty of the information obtained. However， the actual situation contains a variety of uncertainties， and ignoring these uncertainties may lead to safety problems. The measurements provided by the sensors generally include the value of the state and the uncertainty of the state value， which is typically represented by the covariance matrix. At present， most planning methods do not utilize this uncertainty and choose to ignore it directly. These uncertainties will also have an impact on planning； when accumulated over time， the impact may even be sufficiently large to cause serious accidents. If a method or framework that can deal with this uncertainty is available， then additional reference information can be provided for the planning system， which will have a positive effect on driving safety. This paper aims to address a critical challenge in the field of autonomous driving： the effective consideration of uncertainty， particularly focusing on sensor measurement errors. In the complex and dynamic environment of autonomous driving， uncertainties can arise from various sources， posing substantial hurdles to accurate and safe planning. The study delves deep into understanding the intricacies of sensor measurement errors by concentrating on sensor uncertainty， which are vital components of perception systems in autonomous vehicles. The primary objective is to develop robust planning algorithms that can account for these uncertainties， ensuring that autonomous vehicles can make informed decisions even under imperfect or noisy sensor data. This research is pivotal for enhancing the reliability and safety of autonomous driving systems， ultimately paving the way for the widespread adoption of autonomous vehicles by addressing one of the key challenges in their deployment.
Method
2
The methodology in this article revolves around the innovative use of the grid map， a mathematical framework employed to characterize uncertainty as the occupancy probability within a grid map. The process begins by transforming the prior map into a grid map， establishing a global reference. Subsequently， the local grid map is initialized through integration with the localization system， enabling the propagation of localization uncertainty within this localized context. The computational complexity of the planning algorithm is substantially reduced by integrating localization and sensing uncertainties into the grid graph. This integration not only streamlines the planning process but also ensures the efficient and safe generation of optimal trajectories. Path planning is executed within the Frenet coordinate system， where the occupancy probability of the grid map plays a pivotal role. This comprehensive methodology not only accounts for sensor measurement errors but also provides a systematic framework for path planning， ultimately enhancing the reliability and safety of autonomous vehicles in uncertain driving environments.
Result
2
Research findings， validated through extensive simulation tests in the CARLA simulator， confirm the robustness of the proposed methodology. The integration of the approach with the robot operating system （ROS）-based system design， encompassing critical modules such as the map engine， path planning， and scene generation， proved pivotal in achieving these results. Specifically， the experiments demonstrated that considering localization uncertainty led to a notable improvement in the success rate across a range of obstacle avoidance scenarios. The proposed method exhibited exceptional performance， enabling smooth long-distance driving even in environments characterized by positioning uncertainty. The method not only ensured the safe navigation of the vehicle， effectively avoiding obstacles， but also achieved an impressive average arrival rate of over 90% in diverse obstacle avoidance scenarios. These compelling outcomes emphasize the effectiveness and reliability of the developed approach， positioning it as a promising solution for enhancing the safety and efficiency of autonomous vehicles in real-world driving conditions.
Conclusion
2
This research addresses a fundamental challenge in autonomous driving by focusing on the critical aspect of sensor measurement errors， particularly localization uncertainty. The study introduces an innovative grid-map-based planning method， implemented and rigorously tested within the CARLA simulator using the ROS framework. Through meticulous experimentation， the research demonstrates that considering localization uncertainty substantially improves the success rate in various obstacle avoidance scenarios. The proposed approach enables smooth， long-distance driving under positioning uncertainty， ensuring safe obstacle avoidance， and achieving an outstanding average arrival rate of over 90% in diverse scenarios. These results highlight the efficacy and practicality of the developed methodology， demonstrating its potential for real-world application in autonomous driving systems. Through the seamless integration of localization and sensing uncertainties into the planning algorithm， this research not only enhances the reliability and safety of autonomous vehicles but also contributes valuable insights into the ongoing efforts to make autonomous driving a mainstream reality. Future research can further improve the robustness and adaptability of autonomous driving systems by combining the grid-map-based representation framework with the uncertainty of other sensors such as LiDAR and cameras. This comprehensive approach can provide a complete and accurate environmental perception of the system， thereby increasing confidence in decision-making. Researchers can effectively simulate and understand complex situations in actual driving environments by introducing the uncertainty of multiple sensors， thereby providing a reliable foundation for the safe navigation and intelligent decision-making of autonomous vehicles. This scalable research path will have substantial implications for future research on autonomous driving， providing new directions for promoting innovation and development in this field.
不确定性无人驾驶栅格地图轨迹规划Frenet规划传感器误差
uncertaintyautonomous drivinggrid maptrajectory planningFrenet planningsensor error
Althoff M. Reachability Analysis and Its Application to the Safety Assessment of Autonomous cars. Technische Universität München， 2010.
Artunedo A， Villagra J， Godoy J and Del Castillo M D. 2020. Motion planning approach considering localization uncertainty. IEEE Transactions on Vehicular Technology， 69（6）： 5983-5994 ［DOI： 10.1109/TVT.2020.2985546http://dx.doi.org/10.1109/TVT.2020.2985546］
Chen L， Shan Y X， Tian W， Li B J and Cao D P. 2018. A fast and efficient double-tree RRT*-like sampling-based planner applying on mobile robotic systems. IEEE/ASME Transactions on Mechatronics， 23（6）： 2568-2578 ［DOI： 10.1109/TMECH.2018.2821767http://dx.doi.org/10.1109/TMECH.2018.2821767］
Dijkstra E W. 1959. A note on two problems in connexion with graphs. Numerische Mathematik， 1（1）： 269-271 ［DOI： 10.1007/BF01386390http://dx.doi.org/10.1007/BF01386390］
Ebadi K， Bernreiter L， Biggie H， Catt G， Chang Y， Chatterjee A， Denniston C E， Deschênes S P， Harlow K， Khattak S， Nogueira L， Palieri M， Petráček P， Petrlík M， Reinke A， Krátký V， Zhao S B， Agha-Mohammadi A A， Alexis K， Heckman C， Khosoussi K， Kottege N， Morrell B， Hutter M， Pauling F， Pomerleau F， Saska M， Scherer S， Siegwart R， Williams J L and Carlone L. 2024. Present and future of slam in extreme environments： the DARPA SUBT challenge. IEEE Transactions on Robotics， 40： 936-959 ［DOI： 10.1109/TRO.2023.3323938http://dx.doi.org/10.1109/TRO.2023.3323938］
García C E， Prett D M and Morari M. 1989. Model predictive control： theory and practice—A survey. Automatica， 25（3）： 335-348 ［DOI： 10.1016/0005-1098（89）90002-2http://dx.doi.org/10.1016/0005-1098（89）90002-2］
Hart P E， Nilsson N J and Raphael B. 1968. A formal basis for the heuristic determination of minimum cost paths. IEEE Transactions on Systems Science and Cybernetics， 4（2）： 100-107 ［DOI： 10.1109/TSSC.1968.300136http://dx.doi.org/10.1109/TSSC.1968.300136］
Indelman V， Carlone L and Dellaert F. 2015. Planning in the continuous domain： a generalized belief space approach for autonomous navigation in unknown environments. The International Journal of Robotics Research， 34（7）： 849-882 ［DOI： 10.1177/0278364914561102http://dx.doi.org/10.1177/0278364914561102］
Kijewski-Correa T and Kochly M. 2007. Monitoring the wind-induced response of tall buildings： GPS performance and the issue of multipath effects. Journal of Wind Engineering and Industrial Aerodynamics， 95（9/11）： 1176-1198 ［DOI： 10.1016/j.jweia.2007.02.002http://dx.doi.org/10.1016/j.jweia.2007.02.002］
LaValle S. 1998. Rapidly-Exploring Random Trees： A New Tool for Path Planning. Iowa State University
Li B， Ouyang Y K， Li L and Zhang Y M. 2022. Autonomous driving on curvy roads without reliance on frenet frame： a Cartesian-based trajectory planning method. IEEE Transactions on Intelligent Transportation Systems， 23（9）： 15729-15741 ［DOI： 10.1109/TITS.2022.3145389http://dx.doi.org/10.1109/TITS.2022.3145389］
Lim W， Lee S， Sunwoo M and Jo K. 2018. Hierarchical trajectory planning of an autonomous car based on the integration of a sampling and an optimization method. IEEE Transactions on Intelligent Transportation Systems， 19（2）： 613-626 ［DOI： 10.1109/TITS.2017.2756099http://dx.doi.org/10.1109/TITS.2017.2756099］
McNaughton M， Urmson C， Dolan J M and Lee J W. 2011. Motion planning for autonomous driving with a conformal spatiotemporal lattice//Proceedings of 2011 IEEE International Conference on Robotics and Automation. Shanghai， China： IEEE： 4889-4895 ［DOI： 10.1109/ICRA.2011.5980223http://dx.doi.org/10.1109/ICRA.2011.5980223］
Park S， Lim W and Sunwoo M. 2019. Robust lane-change recognition based on an adaptive hidden Markov model using measurement uncertainty. International Journal of Automotive Technology， 20（2）： 255-263 ［DOI： 10.1007/s12239-019-0025-8http://dx.doi.org/10.1007/s12239-019-0025-8］
Paulson J A， Buehler E A， Braatz R D and Mesbah A. 2020. Stochastic model predictive control with joint chance constraints. International Journal of Control， 93（1）： 126-139 ［DOI： 10.1080/00207179.2017.1323351http://dx.doi.org/10.1080/00207179.2017.1323351］
Renganathan V， Safaoui S， Kothari A， Gravell B， Shames I and Summers T. 2023. Risk bounded nonlinear robot motion planning with integrated perception and control. Artificial Intelligence， 314： #103812 ［DOI： 10.1016/j.artint.2022.103812http://dx.doi.org/10.1016/j.artint.2022.103812］
Schindler A. 2013. Vehicle self-localization with high-precision digital maps//2013 IEEE Intelligent Vehicles Symposium Workshops （IV Workshops）. Gold Coast， Australia： IEEE： 134-139 ［DOI： 10.1109/IVWorkshops.2013.6615239http://dx.doi.org/10.1109/IVWorkshops.2013.6615239］
Schreier M， Willert V and Adamy J. 2016. An integrated approach to maneuver-based trajectory prediction and criticality assessment in arbitrary road environments. IEEE Transactions on Intelligent Transportation Systems， 17（10）： 2751-2766 ［DOI： 10.1109/TITS.2016.2522507http://dx.doi.org/10.1109/TITS.2016.2522507］
Shan Y X， Huang R H， He Z， Gong Z H， Jing M and Zou X S. 2021. Human-like steering model for autonomous driving based on deep pure pursuit method. Journal of Image and Graphics， 26（1）： 176-185
单云霄， 黄润辉， 何泽， 龚志豪， 景民， 邹雪松. 2021. 深度纯追随的拟人化无人驾驶转向控制模型. 中国图象图形学报， 26（1）： 176-185 ［［DOI： 10.11834/jig.200396http://dx.doi.org/10.11834/jig.200396］
Shan Y X， Zheng B L， Chen L S， Chen L and Chen D. 2020. A reinforcement learning-based adaptive path tracking approach for autonomous driving. IEEE Transactions on Vehicular Technology， 69（10）： 10581-10595 ［DOI： 10.1109/TVT.2020.3014628http://dx.doi.org/10.1109/TVT.2020.3014628］
Teng S Y， Hu X M， Deng P， Li B， Li Y C， Ai Y F， Yang D S， Li L X， Zhe X Y， Zhu F H and Chen L. 2023. Motion planning for autonomous driving： the state of the art and future perspectives. IEEE Transactions on Intelligent Vehicles， 8（6）： 3692-3711 ［DOI： 10.1109/TIV.2023.3274536http://dx.doi.org/10.1109/TIV.2023.3274536］
Wang Y N. 2021. Local Path Planning and Robust Optimal Control for Automated Driving with Uncertain Parameters. Wuhan： Huazhong University of Science and Technology
王亚男. 2021. 含不确定性参数的自动驾驶局部路径规划及稳健优化控制. 武汉： 华中科技大学 ［DOI： 10.27157/d.cnki.ghzku.2021.002029http://dx.doi.org/10.27157/d.cnki.ghzku.2021.002029］
Wang Y Y. 2021. Research on Trajectory Planning Algorithm of Driverless Vehicle Considering Uncertainty. Jilin： Jilin University.
王媛媛. 2021. 考虑不确定性的无人驾驶汽车轨迹规划算法研究. 吉林： 吉林大学 ［DOI： 10.27162/d.cnki.gjlin.2021.006397http://dx.doi.org/10.27162/d.cnki.gjlin.2021.006397］
Werling M， Ziegler J， Kammel S and Thrun S. 2010. Optimal trajectory generation for dynamic street scenarios in a Frenét frame//Proceedings of 2010 IEEE International Conference on Robotics and Automation. Anchorage， USA： IEEE： 987-993 ［DOI： 10.1109/ROBOT.2010.5509799http://dx.doi.org/10.1109/ROBOT.2010.5509799］
Zhan J， Guo C， Lei T T， Qu Y Q， Wu H B and Liu J N. 2021. Comparative study on data standards of autonomous driving map. Journal of Image and Graphics， 26（1）： 36-48
詹骄， 郭迟， 雷婷婷， 屈宜琪， 吴杭彬， 刘经南. 2021. 自动驾驶地图的数据标准比较研究. 中国图象图形学报， 26（1）： 36-48 ［DOI： 10.11834/jig.200414http://dx.doi.org/10.11834/jig.200414］
Zhang H. 2022. Intelligent Vehicle Driving Situation Assessment and Interactive Decision-Making Considering Uncertainties. Hangzhou： Zhejiang University
张婳. 2022. 考虑不确定性的智能车行车态势评估和交互性决策. 杭州： 浙江大学 ［DOI： 10.27461/d.cnki.gzjdx.2022.001685http://dx.doi.org/10.27461/d.cnki.gzjdx.2022.001685］
Zhu H and Alonso-Mora J. 2019. Chance-constrained collision avoidance for MAVs in dynamic environments. IEEE Robotics and Automation Letters， 4（2）： 776-783 ［DOI： 10.1109/LRA.2019.2893494http://dx.doi.org/10.1109/LRA.2019.2893494］
相关作者
相关机构
京公网安备11010802024621