Skip to main content
Log in

Structured road-oriented motion planning and tracking framework for active collision avoidance of autonomous vehicles

  • Article
  • Published:
Science China Technological Sciences Aims and scope Submit manuscript

Abstract

This paper proposes a novel motion planning and tracking framework based on improved artificial potential fields (APFs) and a lane change strategy to enhance the performance of the active collision avoidance systems of autonomous vehicles on structured roads. First, an improved APF-based hazard evaluation module, which is inspired by discrete optimization, is established to describe driving hazards in the Frenet-Serret coordinate. Next, a strategy for changing lane is developed in accordance with the characteristics of the gradient descent method (GDM). On the basis of the potential energy distribution of the target obstacle and road boundaries, GDM is utilized to generate the path for changing lane. In consideration of the safety threats of traffic participants, the effects of other obstacles on safety are taken as additional safety constraints when the lane-changing speed profile for ego vehicles is designed. Then, after being mapped into the Cartesian coordinate, the feasible trajectory is sent to the tracking layer, where a proportional-integral control and model predictive control (PI-MPC) based coordinated controller is applied. Lastly, several cases composed of different road geometrics and obstacles are tested to validate the effectiveness of the proposed algorithm. Results illustrate that the proposed algorithm can achieve active collision avoidance in complex traffic scenarios.

This is a preview of subscription content, log in via an institution to check access.

Access this article

Price excludes VAT (USA)
Tax calculation will be finalised during checkout.

Instant access to the full article PDF.

Similar content being viewed by others

References

  1. Wada T, Doi S, Tsuru N, et al. Characterization of expert drivers’ last-second braking and its application to a collision avoidance system. IEEE Trans Intell Transp Syst, 2010, 11: 413–122

    Article  Google Scholar 

  2. Ren Y, Zheng L, Yang W, et al. Potential field-based hierarchical adaptive cruise control for semi-autonomous electric vehicle. Proc Inst Mech Eng Part D–J Auto Eng, 2019, 233: 2479–2491

    Article  Google Scholar 

  3. Graf Plessen M, Bernardini D, Esen H, et al. Spatial-based predictive control and geometric corridor planning for adaptive cruise control coupled with obstacle avoidance. IEEE Trans Contr Syst Technol, 2018, 26: 38–50

    Article  Google Scholar 

  4. Dickmanns E D, Graefe V. Dynamic monocular machine vision. Machine Vis Apps, 1988, 1: 223–240

    Article  Google Scholar 

  5. Vahidi A, Sciarretta A. Energy saving potentials of connected and automated vehicles. Transp Res Part C-Emerg Technol, 2018, 95: 822–843

    Article  Google Scholar 

  6. Gonzalez D, Perez J, Milanes V, et al. A review of motion planning techniques for automated vehicles. IEEE Trans Intell Transp Syst, 2016, 17: 1135–1145

    Article  Google Scholar 

  7. Bohren J, et al. Little ben: The ben franklin racing team’s entry in the 2007 darpa urban challenge. J Field Robot, 2008, 25: 598–614

    Article  Google Scholar 

  8. Bacha A, Bauman C, Faruque R, et al. Odin: Team victortango’s entry in the darpa urban challenge. J Field Robot, 2008, 25: 467–492

    Article  Google Scholar 

  9. Montemerlo M, Becker J, Bhat S, et al. Junior: The stanford entry in the urban challenge. J Field Robot, 2008, 25: 569–597

    Article  Google Scholar 

  10. Kushleyev A, Likhachev M. Time-bounded lattice for efficient planning in dynamic environments. In: Proceedings of the 2009 IEEE International Conference on Robotics and Automation. IEEE, 2009. 4303–4309

  11. Pivtoraiko M, Kelly A. Efficient constrained path planning via search in state lattices. In: Proceedings of International Symposium Artificial Intelligence Robotics & Automation in Space. Munich, 2005. 1–7

  12. Kavraki L E, Svestka P, Latombe J C, et al. Probabilistic roadmaps for path planning in high-dimensional configuration spaces. IEEE Trans Robot Automat, 1996, 12: 566–580

    Article  Google Scholar 

  13. LaValle S M, Kuffner Jr. J J. Randomized kinodynamic planning. Int J Robot Res, 2001, 20: 378–400

    Article  Google Scholar 

  14. Brezak M, Petrovic I. Real-time approximation of clothoids with bounded error for path planning applications. IEEE Trans Robot, 2014, 30: 507–515

    Article  Google Scholar 

  15. Perez J, Lattarulo R, Nashashibi F. Dynamic trajectory generation using continuous-curvature algorithms for door to door assistance vehicles. In: Proceedings of Intelligent Vehicle Symposium. IEEE, 2014. 510–515

  16. Liang Z, Zheng G, Li J. Automatic parking path optimization based on bezier curve fitting. In: Proceedings of IEEE International Conference on Automation & Logistics. IEEE, 2012. 583–587

  17. Berglund T, Brodnik A, Jonsson H, et al. Planning smooth and obstacle-avoiding b-spline paths for autonomous mining vehicles. IEEE Trans Automat Sci Eng, 2010, 7: 167–172

    Article  Google Scholar 

  18. Piazzi A, Lo Bianco C G, Bertozzi M, et al. Quintic G/sup 2/-splines for the iterative steering of vision-based autonomous vehicles. IEEE Trans Intell Transp Syst, 2002, 3: 27–36

    Article  Google Scholar 

  19. Ziegler J, Bender P, Schreiber M, et al. Making bertha drive—An autonomous journey on a historic route. IEEE Intell Transp Syst Mag, 2014, 6: 8–20

    Article  Google Scholar 

  20. Song X, Cao H, Huang J. Vehicle path planning in various driving situations based on the elastic band theory for highway collision avoidance. Proc Inst Mech Eng Part D–J Autom Eng, 2013, 227: 1706–1722

    Article  Google Scholar 

  21. Ji J, Khajepour A, Melek W W, et al. Path planning and tracking for vehicle collision avoidance based on model predictive control with multiconstraints. IEEE Trans Veh Technol, 2017, 66: 952–964

    Article  Google Scholar 

  22. Hang P, Lv C, Huang C, et al. An integrated framework of decision making and motion planning for autonomous vehicles considering social behaviors. IEEE Trans Veh Technol, 2020, 69: 14458–14469

    Article  Google Scholar 

  23. Li X, Xu S, Li S, et al. Simultaneous obstacle avoidance and target tracking of multiple wheeled mobile robots with certified safety. IEEE Trans Cybern, 2021, doi: https://doi.org/10.1109/TCYB.2021.3070385

  24. Rasekhipour Y, Khajepour A, Chen S K, et al. A potential field-based model predictive path-planning controller for autonomous road vehicles. IEEE Trans Intell Transp Syst, 2017, 18: 1255–1267

    Article  Google Scholar 

  25. Wang H, Huang Y, Khajepour A, et al. Crash mitigation in motion planning for autonomous vehicles. IEEE Trans Intell Transp Syst, 2019, 20: 3313–3323

    Article  Google Scholar 

  26. Xu Z, Li S, Zhou X, et al. Dynamic neural networks for motion-force control of redundant manipulators: An optimization perspective. IEEE Trans Ind Electron, 2021, 68: 1525–1536

    Article  Google Scholar 

  27. Han G, Fu W, Wang W, et al. The lateral tracking control for the intelligent vehicle based on adaptive PID neural network. Sensors, 2017, 17: 1244–1258

    Article  Google Scholar 

  28. Wang Y, Ding H, Yuan J, et al. Output-feedback triple-step coordinated control for path following of autonomous ground vehicles. Mech Syst Signal Process, 2019, 116: 146–159

    Article  Google Scholar 

  29. Ji X, Liu Y, He X, et al. Interactive control paradigm-based robust lateral stability controller design for autonomous automobile path tracking with uncertain disturbance: A dynamic game approach. IEEE Trans Veh Technol, 2018, 67: 6906–6920

    Article  Google Scholar 

  30. Ren Y, Zheng L, Khajepour A. Integrated model predictive and torque vectoring control for path tracking of 4-wheel-driven autonomous vehicles. IET Intell Transp Syst, 2019, 13: 98–107

    Article  Google Scholar 

  31. Guo H, Liu J, Cao D, et al. Dual-envelop-oriented moving horizon path tracking control for fully automated vehicles. Mechatronics, 2018, 50: 422–433

    Article  Google Scholar 

  32. Barfoot T D, Clark C M. Motion planning for formations of mobile robots. Robotics Autonomous Syst, 2004, 46: 65–78

    Article  Google Scholar 

  33. Hu X, Chen L, Tang B, et al. Dynamic path planning for autonomous driving on various roads with avoidance of static and moving obstacles. Mech Syst Signal Process, 2018, 100: 482–500

    Article  Google Scholar 

  34. Wahid N, Zamzuri H, Rahman M, et al. Study on potential field based motion planning and control for automated vehicle collision avoidance systems. In: Proceedings of 2017 IEEE International conference on Mechatronics. IEEE, 2017. 208–213

  35. Wang P, Gao S, Li L, et al. Obstacle avoidance path planning design for autonomous driving vehicles based on an improved artificial potential field algorithm. Energies, 2019, 12: 2342

    Article  Google Scholar 

  36. Wang H, Kearney J, Atkinson K. Arc-length parameterized spline curves for real-time simulation. In: Proceedings of 5th International Conference on Curves and Surfaces (ICCS), 2002

  37. Li S, Li K, Rajamani R, et al. Model predictive multi-objective vehicular adaptive cruise control. IEEE Trans Contr Syst Technol, 2011, 19: 556–566

    Article  Google Scholar 

  38. Huang Y, Khajepour A, Zhu T, et al. A supervisory energy-saving controller for a novel anti-idling system of service vehicles. IEEE/ASME Trans Mechatron, 2017, 22: 1037–1046

    Article  Google Scholar 

Download references

Author information

Authors and Affiliations

Authors

Corresponding author

Correspondence to Ling Zheng.

Additional information

This work was supported by the National Natural Science Foundation of China (Grant No. 51875061), the Technological Innovation and Application Development of Chongqing (Grant No. cstc2019jscx-zdztzxX0032), and the Graduate Scientific Research and Innovation Foundation of Chongqing, China (Grant No. CYB19063).

Rights and permissions

Reprints and permissions

About this article

Check for updates. Verify currency and authenticity via CrossMark

Cite this article

Zhang, Z., Zheng, L., Li, Y. et al. Structured road-oriented motion planning and tracking framework for active collision avoidance of autonomous vehicles. Sci. China Technol. Sci. 64, 2427–2440 (2021). https://doi.org/10.1007/s11431-021-1880-1

Download citation

  • Received:

  • Accepted:

  • Published:

  • Issue Date:

  • DOI: https://doi.org/10.1007/s11431-021-1880-1

Keywords

Navigation