Abstract
The trajectory planning plays an important role in realizing the autonomous driving process. The trajectory that reflects the driving habits of human drivers and conforms with people’s driving intuition enables a vehicle to operate smoother and more comfortable when passing through corners, which could improve the acceptability of autonomous vehicles in the market in the future. The research of this paper focuses on planning a human driving characterised trajectory along a road based on the test track that could reflect natural driving behaviour in corners considering the sense of natural and comfortable for the occupants. Firstly, the data collected of the test track are processed and the coordinate system transformation is completed, and the human tested trajectories in the test track is extracted and analysed. Then, the human driving characterised trajectory planning is completed based on optimal control in a lane section on the test track. The trajectory tracking control algorithm based on LQR is designed, and a CarSim/Simulink co-simulation platform is established to track the optimal trajectory generated in a lane and the lane centreline trajectory to verify the superiority of the planned trajectory. The results show that compared with the centreline trajectory, the human driving characterised trajectory planned enables the autonomous vehicle operates smoother and more comfortable, and reflects the characteristic of human drivers to a large extent.
Similar content being viewed by others
References
J. Shin, D. Kwak, and K. Kwak, “Model predictive path planning for an autonomous ground vehicle in rough terrain,” International Journal of Control, Automation, and Systems, vol. 19, no. 6, pp. 2224–2237, 2021.
C. You, J. Lu, D. Filev, and P. Tsiotras, “Advanced planning for autonomous vehicles using reinforcement learning and deep inverse reinforcement learning,” Robotics and Autonomous Systems, vol. 114, pp. 1–18, 2019.
B. Paden, M. Čáp, S. Z. Yong, D. Yershov, and E. Frazzoli, “A survey of motion planning and control techniques for self-driving urban vehicles,” IEEE Transactions on Intelligent Vehicles, vol. 1, no. 1, pp. 33–55, 2016.
M. Park and Y. Kang, “Experimental verification of a drift controller for autonomous vehicle tracking: A circular trajectory using LQR method,” International Journal of Control, Automation, and Systems, vol. 19, no. 1, pp. 404–416, 2021.
X. Sun, Y. Cai, S. Wang, X. Xu, and L. Chen, “Optimal control of intelligent vehicle longitudinal dynamics via hybrid model predictive control,” Robotics and Autonomous Systems, vol. 112, pp. 190–200, 2019.
J. Xie, X. Xu, F. Wang, Z. Tang, and L. Chen, “Coordinated control based path following of distributed drive autonomous electric vehicles with yaw-moment control,” Control Engineering Practice, vol. 106, 104659, 2021.
M. Zhu, H. Chen, and G. Xiong, “A model predictive speed tracking control approach for autonomous ground vehicles,” Mechanical Systems and Signal Processing, vol. 87, pp. 138–152, 2017.
J. Choi and K. Kong, “Optimal sensor fusion and position control of a low-price self-driving vehicle in short-term operation conditions,” International Journal of Control, Automation, and Systems, vol. 15, no. 6, pp. 2859–2870, 2017.
E. Alcalá, V. Puig, and J. Quevedo, “LPV-MP planning for autonomous racing vehicles considering obstacles,” Robotics and Autonomous Systems, vol. 124, 103392, 2020.
J.-C. Kim, D.-S. Pae, and M.-T. Lim, “Obstacle avoidance path planning based on output constrained model predictive control,” International Journal of Control, Automation, and Systems, vol. 17, no. 11, pp. 2850–2861, 2019.
M. Parent, F. Harashima, and L. Vlacic, “Intelligent vehicle technologies: Theory and applications,” Ljubo Vlacic, Michel Parent, and Fumio Harashima. Butterworth-Heinemann, pp. 3–19, 2001.
H. I. Kang, B. Lee, and K. Kim, “Path planning algorithm using the particle swarm optimization and the improved Dijkstra algorithm,” Proc. of IEEE Pacific-Asia Workshop on Computational Intelligence and Industrial Application, vol. 2, IEEE, pp. 1002–1004, 2008.
D. González, J. Pérez, V. Milanés, and F. Nashashibi, “A review of motion planning techniques for automated vehicles,” IEEE Transactions on Intelligent Transportation Systems, vol. 17, no. 4, pp. 1135–1145, 2015.
K. Chu, M. Lee, and M. Sunwoo, “Local path planning for off-road autonomous driving with avoidance of static obstacles,” IEEE Transactions on Intelligent Transportation Systems, vol. 13, no. 4, pp. 1599–1616, 2012.
J. J. Kuffner and S. M. LaValle, “RRT-connect: An efficient approach to single-query path planning,” Proc. of ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No. 00CH37065), vol. 2, IEEE, pp. 995–1001, 2000.
S. Karaman and E. Frazzoli, “Sampling-based algorithms for optimal motion planning,” The International Journal of Robotics Research, vol. 30, no. 7, pp. 846–894, 2011.
S. Karaman, M. R. Walter, A. Perez, E. Frazzoli, and S. Teller, “Anytime motion planning using the RRT,” Proc. of IEEE International Conference on Robotics and Automation, IEEE, pp. 1478–1483, 2011.
L. Huajun, Y. Jingyu, L. Jianfeng, T. Zhenmin, Z. Chunxia, and C. Weiming, “Research on mobile robots motion planning: A survey,” Engineering Science, vol. 1, 2006.
L. Chen, D. Qin, X. Xu, Y. Cai, and J. Xie, “A path and velocity planning method for lane changing collision avoidance of intelligent vehicle based on cubic 3-D Bezier curve,” Advances in Engineering Software, vol. 132, pp. 65–73, 2019.
J. Ziegler, P. Bender, T. Dang, and C. Stiller, “Trajectory planning for Bertha-A local, continuous method,” Proc. of IEEE Intelligent Vehicles Symposium Proceedings, IEEE, pp. 450–457, 2014.
B. Li and Z. Shao, “A unified motion planning method for parking an autonomous vehicle in the presence of irregularly placed obstacles,” Knowledge-based Systems, vol. 86, pp. 11–20, 2015.
J. Nilsson, M. Ali, P. Falcone, and J. Sjöberg, “Predictive manoeuvre generation for automated driving,” Proc. of 16th International IEEE Conference on Intelligent Transportation Systems (ITSC2013), IEEE, pp. 418–423, 2013.
O. Khatib, “Real-time obstacle avoidance for manipulators and mobile robots,” Autonomous Robot Vehicles, Springer, pp. 396–404, 1986.
H.-T. Chiang, N. Malone, K. Lesser, M. Oishi, and L. Tapia, “Path-guided artificial potential fields with stochastic reachable sets for motion planning in highly dynamic environments,” Proc. of IEEE International Conference on Robotics and Automation (ICRA), IEEE, pp. 2347–2354, 2015.
P.-Y. Zhang, T.-S. Lü, and L.-B. Song, “Soccer robot path planning based on the artificial potential field approach with simulated annealing,” Robotica, vol. 22, no. 5, pp. 563–566, 2004.
B. Li, Research on Computational Optimal Control Methods for Automated Vehicle Motion Planning Problems with Complicated Constraints, Ph.D. Dissertation, Zhejiang University, 2018.
M. Sever, N. Zengin, A. Kirli, and M. S. Arslan, “Carsickness-based design and development of a controller for autonomous vehicles to improve the comfort of occupants,” Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering, vol. 235, no. 1, pp. 162–176, 2021.
W. Wei, C. Huiyan, M. Jianhao, L. Kai, and G. Jianwei, “Path tracking for intelligent vehicles based on frenet coordinates and delayed control,” Acta Armamentarii, vol. 40, no. 11, 2336, 2019.
V. Cossalter, M. Da Lio, R. Lot, and L. Fabbri, “A general method for the evaluation of vehicle manoeuvrability with special emphasis on motorcycles,” Vehicle System Dynamics, vol. 31, no. 2, pp. 113–135, 1999.
G. Perantoni and D. J. Limebeer, “Optimal control for a formula one car with variable parameters,” Vehicle System Dynamics, vol. 52, no. 5, pp. 653–678, 2014.
T. D. Barfoot and C. M. Clark, “Motion planning for formations of mobile robots,” Robotics and Autonomous Systems, vol. 46, no. 2, pp. 65–78, 2004.
M. A. Patterson and A. V. Rao, “GPOPS-II: A MATLAB software for solving multiple-phase optimal control problems using hp-adaptive Gaussian quadrature collocation methods and sparse nonlinear programming,” ACM Transactions on Mathematical Software (TOMS), vol. 41, no. 1, pp. 1–37, 2014.
J. Gong, Y. Jiang, and W. Xu, Model Predictive Control for Self-driving Vehicles, Beijing Institute of Technology Press, Beijing, China, 2014.
L. Chen, X. Li, W. Xiao, P. Li, and Q. Zhou, “Fault-tolerant control for uncertain vehicle active steering systems with time-delay and actuator fault,” International Journal of Control, Automation, and Systems, vol. 17, no. 9, pp. 2234–2241, 2019.
P. Li, A.-T. Nguyen, H. Du, Y. Wang, and H. Zhang, “Polytopic LPV approaches for intelligent automotive systems: State of the art and future challenges,” Mechanical Systems and Signal Processing, vol. 161, 107931, 2021.
X. Xu, Z. Liu, F. Wang, J. Xie, and P. Su, “Trajectory tracking control based on the dual-motor autonomous steering system with time-varying network-induced time delay,” Control Engineering Practice, vol. 116, 104915, 2021.
Author information
Authors and Affiliations
Corresponding authors
Additional information
Xing Xu received his B.Sc. degree in vehicle engineering, an M.Sc. degree in control theory and control engineering, and a Ph.D. degree in agricultural electrification and automation from Jiangsu University, Zhenjiang, China, in 2002, 2006, and 2010, respectively. He is currently a Professor with the Automotive Engineering Research Institute, Jiangsu University. His research interests include modeling, optimization, fault diagnosis, and control of vehicle dynamic systems.
Xinwei Jiang received his B.Sc. and M.Sc. degrees in vehicle engineering from Jiangsu University, Zhenjiang, China, in 2016 and 2019, respectively. He is currently a Ph.D. candidate with the Automotive Engineering Research Institute, Jiangsu University. His research interests include autonomous driving technology and automotive electronic control.
Ju Xie received his B.Sc. and M.Sc. degrees in vehicle engineering from Jiangsu University, Zhenjiang, China, in 2015 and 2018, respectively. He is currently a Ph.D. candidate with the Automotive Engineering Research Institute, Jiangsu University. His research interests include vehicle dynamics and control, driver behavior modeling, and intelligent control for autonomous vehicles.
Feng Wang received his B.Sc. and Ph.D. degrees from Northwestern Polytechnical University, Xi’an, China, in 2008 and 2014, respectively. He is currently an Associate Professor with the Automotive Engineering Research Institute, Jiangsu University. His research interests include analysis and control of complex electromechanical coupling transmission system and matching, and optimization and coordinated control of hybrid multi-power source coupling transmission system.
Minglei Li received his B.Sc. and M.Sc. degrees in vehicle engineering from Jiangsu University, Zhenjiang, China, in 2018 and 2021, respectively. He is currently an engineer with the Pan Asia Technical Automotive Center. His research interests include autonomous driving technology and automotive path-following control.
Publisher’s Note Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
This work was supported by the Primary Research & Development Plan of Jiangsu Province (No. BE2019010) and the the National Natural Science Foundation of China (No. U20A20331).
Rights and permissions
About this article
Cite this article
Xu, X., Jiang, X., Xie, J. et al. Research on Human Driving Characterised Trajectory Planning and Trajectory Tracking Control Based on a Test Track. Int. J. Control Autom. Syst. 21, 1258–1272 (2023). https://doi.org/10.1007/s12555-021-0785-6
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s12555-021-0785-6