A Feedback Linearized Model Predictive Control Strategy for Input-Constrained Self-Driving Cars (2405.01753v1)
Abstract: This paper proposes a novel real-time affordable solution to the trajectory tracking control problem for self-driving cars subject to longitudinal and steering angular velocity constraints. To this end, we develop a dual-mode Model Predictive Control (MPC) solution starting from an input-output feedback linearized description of the vehicle kinematics. First, we derive the state-dependent input constraints acting on the linearized model and characterize their worst-case time-invariant inner approximation. Then, a dual-mode MPC is derived to be real-time affordable and ensuring, by design, constraints fulfiLLMent, recursive feasibility, and uniformly ultimate boundedness of the tracking error in an ad-hoc built robust control invariant region. The approach's effectiveness and performance are experimentally validated via laboratory experiments on a Quanser Qcar. The obtained results show that the proposed solution is computationally affordable and with tracking capabilities that outperform two alternative control schemes.
- S. Dixit, S. Fallah, U. Montanaro, M. Dianati, A. Stevens, F. Mccullough, and A. Mouzakitis, “Trajectory planning and tracking for autonomous overtaking: State-of-the-art and future prospects,” Annual Reviews in Control, vol. 45, pp. 76–86, 2018.
- P. Stano, U. Montanaro, D. Tavernini, M. Tufo, G. Fiengo, L. Novella, and A. Sorniotti, “Model predictive path tracking control for automated road vehicles: A review,” Annual reviews in control, vol. 55, pp. 194–236, 2023.
- M. Liu, F. Zhao, J. Yin, J. Niu, and Y. Liu, “Reinforcement-tracking: an effective trajectory tracking and navigation method for autonomous urban driving,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, no. 7, pp. 6991–7007, 2021.
- 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 Trans. on Intelligent Vehicles, vol. 1, no. 1, pp. 33–55, 2016.
- L. Li, J. Li, and S. Zhang, “State-of-the-art trajectory tracking of autonomous vehicles,” Mechanical Sciences, vol. 12, no. 1, pp. 419–432, 2021.
- L. Nie, J. Guan, C. Lu, H. Zheng, and Z. Yin, “Longitudinal speed control of autonomous vehicle based on a self-adaptive pid of radial basis function neural network,” IET Intelligent Transport Systems, vol. 12, no. 6, pp. 485–494, 2018.
- H. T. Abatari and A. D. Tafti, “Using a fuzzy pid controller for the path following of a car-like mobile robot,” in 2013 First RSI/ISM international conference on robotics and mechatronics (ICRoM). IEEE, 2013, pp. 189–193.
- Y. Wu, L. Wang, J. Zhang, and F. Li, “Path following control of autonomous ground vehicle based on nonsingular terminal sliding mode and active disturbance rejection control,” IEEE Transactions on Vehicular Technology, vol. 68, no. 7, pp. 6379–6390, 2019.
- M. Shirzadeh, M. H. Shojaeefard, A. Amirkhani, and H. Behroozi, “Adaptive fuzzy nonlinear sliding-mode controller for a car-like robot,” in 2019 5th conference on knowledge based engineering and innovation (kbei). IEEE, 2019, pp. 686–691.
- J. Hu, Y. Zhang, and S. Rakheja, “Adaptive trajectory tracking for car-like vehicles with input constraints,” IEEE Transactions on Industrial Electronics, vol. 69, no. 3, pp. 2801–2810, 2021.
- S. Kuutti, R. Bowden, Y. Jin, P. Barber, and S. Fallah, “A survey of deep learning applications to autonomous vehicle control,” IEEE Transactions on Intelligent Transportation Systems, vol. 22, no. 2, pp. 712–733, 2020.
- S. Grigorescu, B. Trasnea, T. Cocias, and G. Macesanu, “A survey of deep learning techniques for autonomous driving,” Journal of field robotics, vol. 37, no. 3, pp. 362–386, 2020.
- P. F. Lima, G. C. Pereira, J. Mårtensson, and B. Wahlberg, “Experimental validation of model predictive control stability for autonomous driving,” Control Engineering Practice, vol. 81, pp. 244–255, 2018.
- E. F. Camacho and C. Bordons, “Nonlinear model predictive control,” in Model Predictive Control. Springer, 2007, pp. 249–288.
- P. Falcone, F. Borrelli, J. Asgari, H. E. Tseng, and D. Hrovat, “Predictive active steering control for autonomous vehicle systems,” IEEE Transactions on control systems technology, vol. 15, no. 3, pp. 566–580, 2007.
- F. Borrelli, P. Falcone, T. Keviczky, J. Asgari, and D. Hrovat, “Mpc-based approach to active steering for autonomous vehicle systems,” International journal of vehicle autonomous systems, vol. 3, no. 2-4, pp. 265–291, 2005.
- H. Pang, M. Liu, C. Hu, and N. Liu, “Practical nonlinear model predictive controller design for trajectory tracking of unmanned vehicles,” Electronics, vol. 11, no. 7, p. 1110, 2022.
- M. Cho, Y. Lee, and K.-S. Kim, “Model predictive control of autonomous vehicles with integrated barriers using occupancy grid maps,” IEEE Robotics and Automation Letters, vol. 8, no. 4, pp. 2006–2013, 2023.
- W. Schwarting, J. Alonso-Mora, L. Paull, S. Karaman, and D. Rus, “Safe nonlinear trajectory generation for parallel autonomy with a dynamic vehicle model,” IEEE Transactions on Intelligent Transportation Systems, vol. 19, no. 9, pp. 2994–3008, 2017.
- M. Nezami, D. S. Karachalios, G. Schildbach, and H. S. Abbas, “On the design of nonlinear mpc and lpvmpc for obstacle avoidance in autonomous driving,” in 2023 9th International Conference on Control, Decision and Information Technologies (CoDIT). IEEE, 2023, pp. 1–6.
- F. Eiras, M. Hawasly, S. V. Albrecht, and S. Ramamoorthy, “A two-stage optimization-based motion planner for safe urban driving,” IEEE Trans. on Robotics, vol. 38, no. 2, pp. 822–834, 2021.
- J. Funke, M. Brown, S. M. Erlien, and J. C. Gerdes, “Collision avoidance and stabilization for autonomous vehicles in emergency scenarios,” IEEE Transactions on Control Systems Technology, vol. 25, no. 4, pp. 1204–1216, 2016.
- C. E. Beal and J. C. Gerdes, “Model predictive control for vehicle stabilization at the limits of handling,” IEEE Transactions on Control Systems Technology, vol. 21, no. 4, pp. 1258–1269, 2012.
- K. Majd, M. Razeghi-Jahromi, and A. Homaifar, “A stable analytical solution method for car-like robot trajectory tracking and optimization,” IEEE/CAA Journal of Automatica Sinica, vol. 7, no. 1, pp. 39–47, 2019.
- A. De Luca, G. Oriolo, and C. Samson, “Feedback control of a nonholonomic car-like robot,” Robot motion planning and control, pp. 171–253, 2005.
- J. Deng, V. Becerra, and R. Stobart, “Input constraints handling in an MPC/feedback linearization scheme,” Int. Journal of Applied Mathematics and Computer Science, vol. 19, no. 2, pp. 219–232, 2009.
- D. Simon, J. Löfberg, and T. Glad, “Nonlinear model predictive control using feedback linearization and local inner convex constraint approximations,” in 2013 European Control Conference (ECC). IEEE, 2013, pp. 2056–2061.
- C. Tiriolo and W. Lucia, “On the design of control invariant regions for feedback linearized car-like vehicles,” IEEE Control Systems Letters, vol. 7, pp. 739–744, 2022.
- C. Tiriolo, G. Franzè, and W. Lucia, “A receding horizon trajectory tracking strategy for input-constrained differential-drive robots via feedback linearization,” IEEE Transactions on Control Systems Technology, vol. 31, no. 3, pp. 1460–1467, 2022.
- D. Q. Mayne, J. B. Rawlings, C. V. Rao, and P. O. Scokaert, “Constrained model predictive control: Stability and optimality,” Automatica, vol. 36, no. 6, pp. 789–814, 2000.
- D. Wang and G. Xu, “Full-state tracking and internal dynamics of nonholonomic wheeled mobile robots,” IEEE/ASME Trans. on Mechatronics, vol. 8, no. 2, pp. 203–214, 2003.
- I. Kolmanovsky and E. G. Gilbert, “Theory and computation of disturbance invariant sets for discrete-time linear systems,” Mathematical problems in engineering, vol. 4, no. 4, pp. 317–367, 1998.
- R. Van Der Merwe and E. A. Wan, “The square-root unscented kalman filter for state and parameter-estimation,” in 2001 IEEE international conference on acoustics, speech, and signal processing. Proceedings (Cat. No. 01CH37221), vol. 6. IEEE, 2001, pp. 3461–3464.
- H. G. Tanner and K. J. Kyriakopoulos, “Backstepping for nonsmooth systems,” Automatica, vol. 39, no. 7, pp. 1259–1265, 2003.