Research on Temporal Consistency and Robustness in Local Planning of Intelligent Vehicles
-
摘要: 在无人驾驶系统中,局部规划在跟踪全局路径的同时完成避障,提高了规划系统在动态未知环境中的工作能力.避障分析的有效性是局部规划最重要的功能之一.然而在仿真和实车测试中发现,广泛使用的基于优化求解的局部规划算法无法在不依赖全局精确定位时保证规划结果满足时间一致性要求.时间不一致将导致车辆的实际行驶路线偏离初始规划结果,造成避障分析失效.本文设计了基于前向预测的局部路径规划算法,在不依赖全局精确定位的前提下保证规划结果的时间一致性.除了时间一致性问题外,跟踪控制误差也是导致规划结果避障分析失效的主要原因之一.现有研究大多通过膨胀障碍物体现误差的影响,然而这种方法无法避免车辆驶入膨胀危险区域而停车.本算法在路径生成过程中增加误差影响,用通行区域代替原有不具有宽度的规划路径进行避障分析,既可以解决误差导致的避障失效,又避免出现膨胀障碍物带来的问题.通过V-Rep软件与实车规划程序进行联合仿真,在能够体现时间一致性影响的典型场景中对本算法与基于最优化曲线生成的局部路径规划算法进行比较, 验证了该算法具有更好的安全分析有效性.应用本算法的北京理工大学无人驾驶平台参加了2013年智能车未来挑战赛,在无人干预的情况下顺利完成 18公里城郊赛段和5公里城市赛段行驶,展现了良好的避障能力.Abstract: Local planner can improve the capacity of planning system for intelligent vehicles by avoiding obstacles while tracking the reference path. Safety check is the one of the fundamental functions of a local planner. However, revealed by simulation and experiments, the widely used optimization-based local planning methods are unlikely to maintain temporal consistency without any accurate global positioning information. Temporal inconsistency will result in the deviation of the vehicle's actual trajectory from the original planned results, which will finally make the safety check invalid. This paper presents a forward prediction-based local planning algorithm which holds temporal consistency in the results without requiring any accurate global positioning information. Besides the temporal consistency issue, controlling error is another reason for safety check failure. Most current researches take error into consideration by enlarging the size of obstacles. Such methods are unable to prevent the vehicle from entering the dilated obstacle areas. In this paper, controlling error is introduced in the generation of the local paths. The traditional path with no width is replaced by a strip of path here. Based on the simulation results of the V-Rep virtual reality software, the forward prediction-based method features better safety check ability as compared with the optimization-based local planning methods. The proposed algorithm was applied to the intelligent vehicle by Beijing Institute of Technology which participated in The Future Challenge 2013. The vehicle succeeded to finish the event without human operation.
-
Key words:
- Intelligent vehicle /
- local planning /
- temporary consistency /
- robustness
-
[1] Urmson C, Anhalt J, Bagnell D, Baker C, Bittner P, Clark M N, Dolan J, Duggins D, Galatali T, Geyer C, Gittleman M, Harbaugh S, Hebert M, Howard T M, Kolski S, Kelly A, Likhachev M, McNaughton M, Miller N, Peterson K, Pilnick B, Rajkumar R, Rybski P, Salesky B, Seo Y W, Singh S, Snider J, Stentz A, Whittaker W, Wolkowicki Z, Ziglar J, Bae H, Brown T, Demitrish D, Litkouhi B, Nickolaou J, Sadekar V, Zhang W, Struble J, Taylor M, Darms M, Ferguson D. Autonomous driving in urban environments: boss and the urban challenge. Journal of Field Robotics, 2008, 25(8): 425-466 [2] [2] Montemerlo M, Becker J, Bhat S, Dahlkamp H, Dlogov D, Ettinger S, Haehnel A, Hilden T, Hoffmann G, Huhnke B, Johnston D, Klumpp S, Langer D, Levandowski A, LevinsonJ, Marcil J, Orenstein D, Paefgen J, Penny I, Petrovskaya A, Pflueger M, Stanek G, Stavens D, Vogt A, Thrun S. Junior: the Stanford entry in the urban challenge. Journal of Field Robotics, 2008, 25(9): 569-597 [3] [3] Leonard J, How J, Teller S, Berger M, Campbell S, Fiore G, Fletcher L, Frazzoli E, Huang A, Karaman S, Koch O, Kuwata Y, Moore D, Olson E, Peters S, Teo J, Truax R, Walter M, Barrett D, Epstein A, Maheloni K, Moyer K, Jones T, Buckley R, Antone M, Galejs R, Krishnamurthy S, Williams J. A perception-driven autonomous urban vehicle. Journal of Field Robotics, 2008, 25(10): 727-774 [4] [4] Bacha A, Bauman C, Faruque R, Fleming M, Terwelp C, Reinholtz C, Hong D, Wicks A, Alberi T, Anderson D, Cacciola S, Currier P, Dalton A, Farmer J, Hurdus J, Kimme S, King P, Taylor A, Van Covern D, Webster M. Odin: team Victor Tango's entry in the DARPA urban challenge. Journal of Field Robotics, 2008, 25(8): 467-492 [5] [5] Borrelli F, Falcone P, Keviczky T, Asgari J, Hrovat D. MPC-based approach to active steering for autonomous vehicle systems. International Journal on Vehicle Autonomous Systems, 2005, 3(2-4): 265-291 [6] [6] Anderson S J, Peters S C, Pilutti T E, Lagnemma K. An optimal-control-based framework for trajectory planning, threat assessment, and semi-autonomous control of passenger vehicles in hazard avoidance scenarios. International Journal of Vehicle Autonomous Systems, 2010, 8(2-4): 190-216 [7] [7] Von Hundelshausen F, Himmelsbach M, Hecker F, Mueller A, Wuensche H J. Driving with tentacles: integral structures for sensing and motion. Journal of Field Robotics, 2008, 25(9): 640-673 [8] Jiang Yan, Gong Jian-Wei, Xiong Guang-Ming, Chen Hui-Yan. Research on differential constraints-based planning algorithm for autonomous-driving vehicles. Acta Automatica Sinica, 2013, 39(12): 2012-2020(姜岩, 龚建伟, 熊光明, 陈慧岩. 基于运动微分约束的无人车辆纵横向协同规划算法的研究. 自动化学报, 2013, 39(12): 2012-2020) [9] [9] Chu K, Lee M, Sunwoo M. Local path planning for off-road autonomous driving with avoidance of static obstacles. IEEE Transactions on Intelligent Transportation Systems, 2012, 13(4): 1599-1616 [10] Xu W D, Wei J Q, Dolan J M, Zhao H J, Zha H B. A real-time motion planner with trajectory optimization for autonomous vehicles. In: Proceedings of the 2012 IEEE International Conference on Robotics and Automation. Saint Paul, Minnesota, USA: IEEE, 2012. 2061-2067 [11] Kydland F E, Prescott E C. Rules rather than discretion: the inconsistency of optimal plans. The Journal of Political Economy, 1977, 85(3): 473-492. [12] Werling M, Ziegler J, Kammel S, Thrun S. Optimal trajectory generation for dynamic street scenarios in a frent frame. In: Proceedings of the 2010 IEEE International Conference on Robotics and Automation. Anchorage, Alaska, USA: IEEE, 2010. 987-993 [13] Ziegler J, Stiller C. Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios. In: Proceedings of the 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems. St Louis, USA: IEEE, 2009. 1879-1884 [14] Li X H, Sun Z P, Chen Q Y, Liu D X. An adaptive preview path tracker for off-road autonomous driving. In: Proceedings of the 10th IEEE International Conference on Control and Automation (ICCA). Hangzhou, China: IEEE, 2013. 1718-1723 [15] Broggi A, Bertozzi M, Fascioli A, Guarino C, Lo Bianco C G, Piazzi A. The argo autonomous vehicle's vision and control systems. International Journal of Intelligent Control and Systems, 1999, 3(4): 409-441 [16] Kammel S, Ziegler J, Pitzer B, Werling M, Gindele T, Jagzent D, Schroder J, Thuy M, Goebl M, Von Hundelshausen F, Pink O, Frese C, Stiller C. Team AnnieWAY's autonomous system for the 2007 DARPA Urban Challenge. Journal of Field Robotics, 2008, 25(9): 615-639
点击查看大图
计量
- 文章访问数: 2629
- HTML全文浏览量: 170
- PDF下载量: 2876
- 被引次数: 0