In urban driving scenarios, owing to the presence of multiple static obstacles such as parked cars and roadblocks, planning a collision-free and smooth path remains a challenging problem. In addition, the path-planning problem is mostly non-convex, and contains multiple local minima. Therefore, a method for combining a sampling-based method and an optimization-based method is proposed in this paper to generate a collision-free path with kinematic constraints for urban scenarios. The sampling-based method constructs a search graph to search for a seeding path for exploring a safe driving corridor, and the optimization-based method constructs a quadratic programming problem considering the desired state constraints, continuity constraints, driving corridor constraints, and kinematic constraints to perform path optimization. The experimental results show that the proposed method is able to plan a collision-free and smooth path in real time when managing typical urban scenarios.
WANG Liang (王 亮), WANG Bing (王 冰), WANG Chunxiang∗ (王春香)
. Collision-Free Path Planning with Kinematic Constraints in Urban Scenarios[J]. Journal of Shanghai Jiaotong University(Science), 2021
, 26(5)
: 731
-738
.
DOI: 10.1007/s12204-021-2363-8
[1] THRUN S, MONTEMERLO M, DAHLKAMP H, et al. Stanley: The robot that won the DAPPA grand challenge [J]. Journal of ?eld Robotics, 2006, 23(9):
661- 692.
[2] MENGY,WUYM,GUQ,etal. Adecoupledtra-jectory planning framework based on the integration of lattice searching and convex optimization [J]. IEEE Access, 2019, 7: 130530-130551. [3] ZIEGLER J, STILLER C. Spatiotemporal state lat-tices for fast trajectory planning in dynamic on-road driving scenarios [C]//2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.St. Louis, MO: IEEE, 2009: 1879-1884.
[4] MCNAUGHTONM,URMSONC,DOLANJM,et al. Motion planning for autonomous driving with a conformal spatiotemporal lattice [C]//2011 IEEE In-ternational Conference on Robotics and Automation. Shanghai: IEEE, 2011: 4889-4895.
[5] FAN H Y, ZHU F, LIU C C, et al. Baidu Apollo EM motion planner [EB/OL]. [2020-12-22]. https://arxiv.org/pdf/1807.080 48v1.pdf.
[6] WERLING M, ZIEGLER J, KAMMEL S, et al. Opti-mal trajectory generation for dynamic street scenarios in a Fren′et Frame [C]//2010 IEEE International Con-ference on Robotics and Automation. Anchorage, AK: IEEE, 2010: 987-993.
[7] XU W D, WEI J Q, DOLAN J M, et al. A real-time motion planner with trajectory optimization for au-tonomous vehicles [C]//2012 IEEE International Con-ference on Robotics and Automation.SaintPaul,MN: IEEE, 2012: 2061-2067.
[8] GUT,SNIDERJ,DOLANJM,etal. Focused trajectory planning for autonomous on-road driving [C]//2013 IEEE Intelligent Vehicles Symposium (IV ). Gold Coast, QLD: IEEE, 2013: 547-552.
[9] GUTJAHR B, GR ¨OLL L, WERLING M. Lateral ve-hicle trajectory optimization using constrained linear time-varying MPC [J]. IEEE Transactions on Intelli-gent Transportation Systems, 2017, 18(6): 1586-1595.
[10] ZIEGLER J, BENDER P, DANG T, et al. Trajec-tory planning for Bertha: A local, continuous method [C]//2014 IEEE Intelligent Vehicles Symposium Pro-ceedings. Dearborn, MI: IEEE, 2014: 450-457.
[11] WANG Q, SU K F, CAO D P. Path planning for on-road autonomous driving with concentrated itera-tive search [C]//2019 IEEE Intelligent Transportation Systems Conference (ITSC ). Auckland: IEEE, 2019: 2722-2727.
[12] ZHANG Y J, SUN H Y, ZHOU J Y, et al. Optimal vehicle path planning using quadratic optimization for Baidu Apollo open platform [C]//2020 IEEE Intelli-gent Vehicles Symposium (IV ). Las Vegas, NV: IEEE, 2020: 978-984.
[13] STELLATO B, BANJAC G, GOULART P, et al. OSQP: An operator splitting solver for quadratic pro-grams [C]//2018 UKACC 12th International Confer-ence on Control. She?eld: IEEE, 2018: 339.
