This content is not included in
your SAE MOBILUS subscription, or you are not logged in.
Automated Vehicle Path Planning and Trajectory Tracking Control Based on Unscented Kalman Filter Vehicle State Observer
Technical Paper
2021-01-0337
ISSN: 0148-7191, e-ISSN: 2688-3627
This content contains downloadable datasets
Annotation ability available
Sector:
Event:
SAE WCX Digital Summit
Language:
English
Abstract
For automated driving vehicles, path planning and trajectory tracking are the core of achieving obstacle avoidance. Real-time external environment perception and vehicle state monitoring play the important role in the decision-making of vehicle operation. Sensor measuring is an important way to obtain vehicle state parameters, but some parameters cannot be measured due to sensor cost or technical reasons, such as vehicle lateral velocity and side-slip angle. This disadvantage will adversely affect the monitoring of vehicle self-condition and the control of vehicle running, even it will lead to erroneous decision-making of vehicles. Therefore, this paper proposes an automated driving path planning and trajectory tracking control method based on Kalman filter vehicle state observer. Some of vehicle state data can be measured accurately by sensors. The vehicle state observer combined with Adaptive Neural Fuzzy Interference System (ANFIS) and Unscented Kalman filter (UKF) is used to estimate the lateral velocity of the vehicle in real time. The vehicle body state and tire constraints are considered. The model predictive control (MPC) method is used to predict the vehicle and obstacle trajectory and control strategy. Thus, reasonable local path planning is obtained. Finally, some complex scenarios are build including road and dynamic obstacles in scenario builder. Then the path planning strategy is established with Simulink to verify the feasibility of the local path planning theory proposed in this paper.
Authors
Topic
Citation
Chen, Z., Duan, Y., and Zhang, Y., "Automated Vehicle Path Planning and Trajectory Tracking Control Based on Unscented Kalman Filter Vehicle State Observer," SAE Technical Paper 2021-01-0337, 2021, https://doi.org/10.4271/2021-01-0337.Data Sets - Support Documents
Title | Description | Download |
---|---|---|
Unnamed Dataset 1 | ||
Unnamed Dataset 2 | ||
Unnamed Dataset 3 |
Also In
References
- Macadam , C.C. Understanding and Modeling the Human Driver Vehicle System Dynamics 40 1/3 101 134 2003 https://doi.org/10.1076/vesd.40.1.101.15875
- Mayne , D.Q. , Rawlings , J.B. , Rao , C.V. , and Scokaert , P.O.M. Constrained Model Predictive Control: Stability and Optimality Automatica 36 6 789 814 2000 https://doi.org/10.1016/S0005-1098(99)00214-9
- Thrun , S. , Montemerlo , M. , Dahlkamp , H. , Stavens , D. et al. Stanley: The Robot that Won the DARPA Grand Challenge Springer Tracts in Advanced Robotics 23 9 661 692 2007 https://doi.org/10.1007/978-3-540-73429-1_1
- Liu , D. , Wu , J. , Ye , Y. , Shi , J. et al. Research on Multi-Vehicle Coordinated Lane Change of Connected and Automated Vehicles on the Highway SAE Technical Paper 2019-01-0678 2019 https://doi.org/10.4271/2019-01-0678
- Zhan , H. , Shi , S. , Lin , C. , and Huang , Q. Trajectory Tracking Control for Autonomous Driving Vehicle with Obstacle Avoidance: Modeling, Simulation, and Performance Analysis SAE International Journal of Connected and Automated Vehicles 3 1 5 17 2020 https://doi.org/10.4271/12-03-01-0001
- He , X. , Yang , K. , Liu , Y. , and Ji , X. A Novel Direct Yaw Moment Control System for Autonomous Vehicle SAE Technical Paper 2018-01-1594 2018 https://doi.org/10.4271/2018-01-1594
- Mariani , S. , and Ghisi , A. Unscented Kalman Filtering for Nonlinear Structural Dynamics Nonlinear Dynamics 48 1-2 131 150 2007 https://doi.org/10.1007/s11071-006-9118-9
- Lismonde , A. , Sonneville , V. , and Brüls , O. A Geometric Optimization Method for the Path Planning of Flexible Manipulators Multibody System Dynamics 47 3 347 362 2019 https://doi.org/10.1007/s11044-019-09695-z
- Kavraki , L.E. , Kolountzakis , M.N. , and Latombe , J.C. Analysis of Probabilistic Roadmaps for Path Planning Proc.IEEE Int.conf on Robotics and Automation 14 1 166 171 1996 https://doi.org/10.1109/70.660866
- LaValle , S.M. , and Kuffner , J.J. Randomized Kinodynamic Planning International Journal of Robotics Research 15 5 378 400 1999 https://doi.org/10.1177/02783640122067453
- Karaman , S. , and Frazzoli , E. Sampling-Based Algorithms for Optimal Motion Planning International Journal of Robotics Research 30 7 846 894 2011 https://doi.org/10.1177/0278364911406761
- Paden , B. , Čáp , M. , Yong , S.Z. , Yershov , D. , and Frazzoli , E. A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles IEEE Transactions on Intelligent Vehicles 1 1 33 35 2016 https://doi.org/10.1109/TIV.2016.2578706
- Bisht , S.S. , and Singh , M.P. An Adaptive Unscented Kalman Filter for Tracking Sudden Stiffness Changes Mechanical Systems and Signal Processing 49 1-2 181 195 2014 https://doi.org/10.1016/j.ymssp.2014.04.009
- Davoodabadi , I. , Ramezani , A.A. , Mahmoodi-k , M. , and Ahmadizadeh , P. Identification of Tire Forces Using Dual Unscented Kalman Filter Algorithm Nonlinear Dynamics 78 4 1907 1919 2014 https://doi.org/10.1007/s11071-014-1566-z
- Ghosh , S. , Deb , A. , Mahala , M. , Tanbakuchi , M. et al. Active Yaw Control of a Vehicle Using a Fuzzy Logic Algorithm SAE Technical Paper 2012-01-0229 2012 https://doi.org/10.4271/2012-01-0229
- Melzi , S. , and Sabbioni , E. On the Vehicle Sideslip Angle Estimation through Neural Networks: Numerical and Experimental Results Mechanical Systems & Signal Processing 25 6 2005 2019 2011 https://doi.org/10.1016/j.ymssp.2010.10.015
- Boada , B.L. , Boada , M.J.L. , Gauchía , A. , Olmeda , E. , and Díaz , V. Sideslip Angle Estimator Based on ANFIS for Vehicle Handling and Stability Journal of Mechanical Science and Technology 29 4 1473 1481 2015 https://doi.org/10.1007/s12206-015-0320-x
- Jang , R.J.-S. ANFIS: Adaptive-Network-Based Fuzzy Inference System IEEE Transactions on Systems, Man, and Cybernetics 23 3 665 685 1993 https://doi.org/10.1109/21.256541
- Boada , B.L. , Boada , M.J.L. , and Diaz , V. Vehicle Sideslip Angle Measurement Based on Sensor Data Fusion Using an Integrated ANFIS and an Unscented Kalman Filter Algorithm Mechanical Systems and Signal Processing 72-73 May 832 845 2016 https://doi.org/10.1016/j.ymssp.2015.11.003
- Li , J. , and Yi , J. Vehicle Motion Stability with Two Vehicle Dynamics Models ASME 2011 Dynamic Systems and Control Conference and Bath/ASME Symposium on Fluid Power and Motion Control 2 893 900 2011 https://doi.org/10.1115/DSCC2011-6195
- Jing , L. , and Zhang , J. Vehicle Sideslip Angle Estimation Based on Hybrid Kalman Filter Mathematical Problems in Engineering 1 10 2016 https://doi.org/10.1155/2016/3269142
- Yuan , H. , Sun , X. , and Timothy , G. Unified Decision-Making and Control for Highway Collision Avoidance Using Active Front Steer and Individual Wheel Torque Control Vehicle System Dynamics 57 8 1188 1205 2019 https://doi.org/10.1080/00423114.2018.1535125