Trajectory Planning and Tracking for Autonomous Vehicle Based on State Lattice and Model Predictive Control

Trajectory planning and tracking control are two keys of collision avoidance for autonomous vehicles in critical traffic scenarios. It requires not only the system functionality, but also strong real-time. In this paper, we integrated trajectory planner and tracking controller for autonomous vehicle to implement trace planning and tracking for obstacle avoidance. The trajectory planner is based on the state lattice approach and the tracking controller is designed based on the model predictive control using the vehicle kinematics model. The simulation shows that the planner can generate smooth trajectories which could be selected as references for the controller. The maximum tracking error is less than 0.2 m when the vehicle speed is below 50 km/h. Additionally, the on field test shows that the test vehicle with this method is capable of following the reference path accurately, even at sharp corners.

[1]  Francesco Borrelli,et al.  Kinematic and dynamic vehicle models for autonomous driving control design , 2015, 2015 IEEE Intelligent Vehicles Symposium (IV).

[2]  Tatsuya Suzuki,et al.  Realization of different driving characteristics for autonomous vehicle by using model predictive control , 2016, 2016 IEEE Intelligent Vehicles Symposium (IV).

[3]  M. Sunwoo,et al.  Real-time path planning of autonomous vehicles for unstructured road navigation , 2015 .

[4]  Lakhmi C. Jain,et al.  Path Planning and Obstacle Avoidance for Autonomous Mobile Robots: A Review , 2006, KES.

[5]  J. Mikael Eklund,et al.  Obstacle Avoidance in Real Time With Nonlinear Model Predictive Control of Autonomous Vehicles , 2017, Canadian Journal of Electrical and Computer Engineering.

[6]  Manfred Morari,et al.  Use of model predictive control and weather forecasts for energy efficient building climate control , 2012 .

[7]  J. Maciejowski,et al.  Soft constraints and exact penalty functions in model predictive control , 2000 .

[8]  Alonzo Kelly,et al.  Reactive Nonholonomic Trajectory Generation via Parametric Optimal Control , 2003, Int. J. Robotics Res..

[9]  Jan M. Maciejowski,et al.  Predictive control : with constraints , 2002 .

[10]  John M. Dolan,et al.  On-Road Motion Planning for Autonomous Vehicles , 2012, ICIRA.

[11]  Konghui Guo,et al.  Application of Stochastic Model Predictive Control to Modeling Driver Steering Skills , 2016 .

[12]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[13]  Marc Carreras,et al.  A survey on coverage path planning for robotics , 2013, Robotics Auton. Syst..

[14]  Hongbin Zha,et al.  A real-time motion planner with trajectory optimization for autonomous vehicles , 2012, 2012 IEEE International Conference on Robotics and Automation.

[15]  S. LaValle.  Rapidly-exploring random trees : a new tool for path planning , 1998 .

[16]  Riccardo Marino,et al.  Nested PID steering control for lane keeping in autonomous vehicles , 2011 .

[17]  Qi Zhu,et al.  Combining local trajectory planning and tracking control for autonomous ground vehicles navigating along a reference path , 2014, 17th International IEEE Conference on Intelligent Transportation Systems (ITSC).

[18]  D. Rathbun,et al.  An evolution based path planning algorithm for autonomous motion of a UAV through uncertain environments , 2002, Proceedings. The 21st Digital Avionics Systems Conference.

[19]  Rohan Chauhan,et al.  Advanced Driver Assistance Systems , 2016 .

[20]  Julius Ziegler,et al.  Spatiotemporal state lattices for fast trajectory planning in dynamic on-road driving scenarios , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Alonzo Kelly,et al.  Efficient Constrained Path Planning via Search in State Lattices , 2005 .

[22]  Francesco Borrelli,et al.  MPC-Based Approach to Active Steering for Autonomous Vehicle Systems , 2005 .

[23]  Feng Gao,et al.  A comprehensive review of the development of adaptive cruise control systems , 2010 .

[24]  Prof Arun S Tigadi.  ADVANCED DRIVER ASSISTANCE SYSTEMS , 2022 .

[25]  Sebastian Thrun,et al.  Toward robotic cars , 2010, CACM.

[26]  A. Kelly,et al.  Adaptive model-predictive motion planning for navigation in complex environments , 2009 .

[27]  Peter King,et al.  Odin: Team VictorTango's entry in the DARPA Urban Challenge , 2008, J. Field Robotics.

[28]  Karl Berntorp,et al.  Path planning and integrated collision avoidance for autonomous vehicles , 2017, 2017 American Control Conference (ACC).

[29]  Junmin Wang,et al.  A Driver Steering Model With Personalized Desired Path Generation , 2017, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[30]  Julius Ziegler,et al.  Optimal trajectories for time-critical street scenarios using discretized terminal manifolds , 2012, Int. J. Robotics Res..

[31]  Jing Zhou,et al.  Range policy of adaptive cruise control vehicles for improved flow stability and string stability , 2005, IEEE Transactions on Intelligent Transportation Systems.

[32]  Kok Kiong Tan,et al.  Development of a Genetic-Algorithm-Based Nonlinear Model Predictive Control Scheme on Velocity and Steering of Autonomous Vehicles , 2016, IEEE Transactions on Industrial Electronics.

[33]  Matthew McNaughton,et al.  Parallel Algorithms for Real-time Motion Planning , 2011 .

[34]  J. M. D. Silva,et al.  Model Predictive Control of a Mobile Robot Using Linearization , 2022 .

[35]  Daniel D. Lee,et al.  Little Ben: The Ben Franklin Racing Team's entry in the 2007 DARPA Urban Challenge , 2008, J. Field Robotics.

[36]  Maxim Likhachev,et al.  Motion planning in urban environments , 2008 .

[37]  Jin-Woo Lee,et al.  Motion planning for autonomous driving with a conformal spatiotemporal lattice , 2011, 2011 IEEE International Conference on Robotics and Automation.

[38]  Hermann Winner,et al.  Three Decades of Driver Assistance Systems: Review and Future Perspectives , 2014, IEEE Intelligent Transportation Systems Magazine.

[39]  Weiwen Deng,et al.  Dynamic Trajectory Planning for Vehicle Autonomous Driving , 2013, 2013 IEEE International Conference on Systems, Man, and Cybernetics.