GMPC: Geometric Model Predictive Control for Wheeled Mobile Robot Trajectory Tracking (2403.07317v1)
Abstract: The configuration of most robotic systems lies in continuous transformation groups. However, in mobile robot trajectory tracking, many recent works still naively utilize optimization methods for elements in vector space without considering the manifold constraint of the robot configuration. In this letter, we propose a geometric model predictive control (MPC) framework for wheeled mobile robot trajectory tracking. We first derive the error dynamics of the wheeled mobile robot trajectory tracking by considering its manifold constraint and kinematic constraint simultaneously. After that, we utilize the relationship between the Lie group and Lie algebra to convexify the tracking control problem, which enables us to solve the problem efficiently. Thanks to the Lie group formulation, our method tracks the trajectory more smoothly than existing nonlinear MPC. Simulations and physical experiments verify the effectiveness of our proposed methods. Our pure Python-based simulation platform is publicly available to benefit further research in the community.
- Z. Lin, J. Ma, J. Duan, S. E. Li, H. Ma, B. Cheng, and T. H. Lee, “Policy iteration based approximate dynamic programming toward autonomous driving in constrained dynamic environment,” IEEE Transactions on Intelligent Transportation Systems, vol. 24, no. 5, pp. 5003–5013, 2023.
- Z. He, X. Zhang, S. Jones, S. Hauert, D. Zhang, and N. F. Lepora, “TacMMs: Tactile mobile manipulators for warehouse automation,” IEEE Robotics and Automation Letters, vol. 8, no. 8, pp. 4729–4736, 2023.
- C. Cao, H. Zhu, Z. Ren, H. Choset, and J. Zhang, “Representation granularity enables time-efficient autonomous exploration in large, complex worlds,” Science Robotics, vol. 8, no. 80, 2023.
- C. Canudas de Wit and O. Sordalen, “Exponential stabilization of mobile robots with nonholonomic constraints,” in the 30th IEEE Conference on Decision and Control, 1991, pp. 692–697 vol.1.
- A. Astolfi, “Discontinuous control of nonholonomic systems,” Systems & Control Letters, vol. 27, no. 1, pp. 37–45, 1996.
- D. Kostić, S. Adinandra, J. Caarls, N. van de Wouw, and H. Nijmeijer, “Collision-free tracking control of unicycle mobile robots,” in Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 28th Chinese Control Conference, 2009, pp. 5667–5672.
- G. Oriolo, A. De Luca, and M. Vendittelli, “WMR control via dynamic feedback linearization: design, implementation, and experimental validation,” IEEE Transactions on Control Systems Technology, vol. 10, no. 6, pp. 835–852, 2002.
- P. Morin and C. Samson, “Control of nonholonomic mobile robots based on the transverse function approach,” IEEE Transactions on Robotics, vol. 25, no. 5, pp. 1058–1073, 2009.
- J. Pliego-Jiménez, R. Martínez-Clark, C. Cruz-Hernández, and A. Arellano-Delgado, “Trajectory tracking of wheeled mobile robots using only cartesian position measurements,” Automatica, vol. 133, p. 109756, 2021.
- Z. Jian, Z. Lu, X. Zhou, B. Lan, A. Xiao, X. Wang, and B. Liang, “PUTN: A plane-fitting based uneven terrain navigation framework,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022, pp. 7160–7166.
- Z. Jian, Z. Yan, X. Lei, Z. Lu, B. Lan, X. Wang, and B. Liang, “Dynamic control barrier function-based model predictive control to safety-critical obstacle-avoidance of mobile robot,” in IEEE International Conference on Robotics and Automation (ICRA), 2023, pp. 3679–3685.
- J. Song, G. Tao, Z. Zang, H. Dong, B. Wang, and J. Gong, “Isolating trajectory tracking from motion control: A model predictive control and robust control framework for unmanned ground vehicles,” IEEE Robotics and Automation Letters, vol. 8, no. 3, pp. 1699–1706, 2023.
- S. Khan, J. Guivant, and X. Li, “Design and experimental validation of a robust model predictive control for the optimal trajectory tracking of a small-scale autonomous bulldozer,” Robotics and Autonomous Systems, vol. 147, p. 103903, 2022.
- T. A. Howell, B. E. Jackson, and Z. Manchester, “ALTRO: A fast solver for constrained trajectory optimization,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2019, pp. 7674–7679.
- J. Solà, J. Deray, and D. Atchuthan, “A micro lie theory for state estimation in robotics,” ArXiv, vol. abs/1812.01537, 2018.
- B. E. Jackson, K. Tracy, and Z. Manchester, “Planning with attitude,” IEEE Robotics and Automation Letters, vol. 6, no. 3, pp. 5658–5664, 2021.
- G. Alcan, F. J. Abu-Dakka, and V. Kyrki, “Trajectory optimization on matrix lie groups with differential dynamic programming and nonlinear constraints,” ArXiv, vol. abs/2301.02018, 2023.
- G. Lu, W. Xu, and F. Zhang, “On-manifold model predictive control for trajectory tracking on robotic systems,” IEEE Transactions on Industrial Electronics, vol. 70, no. 9, pp. 9192–9202, 2023.
- S. Teng, D. Chen, W. Clark, and M. Ghaffari, “An error-state model predictive control on connected matrix lie groups for legged robot control,” in IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2022, pp. 8850–8857.
- A. Barrau and S. Bonnabel, “The invariant extended kalman filter as a stable observer,” IEEE Transactions on Automatic Control, vol. 62, no. 4, pp. 1797–1812, 2017.
- B. Stellato, G. Banjac, P. Goulart, A. Bemporad, and S. Boyd, “OSQP: an operator splitting solver for quadratic programs,” Mathematical Programming Computation, vol. 12, no. 4, pp. 637–672, 2020.
- H. Ferreau, C. Kirches, A. Potschka, H. Bock, and M. Diehl, “qpOASES: A parametric active-set algorithm for quadratic programming,” Mathematical Programming Computation, vol. 6, no. 4, pp. 327–363, 2014.
- E. Coumans and Y. Bai, “PyBullet, a Python module for physics simulation for games, robotics and machine learning,” http://pybullet.org, 2016–2021.
- J. A. Andersson, J. Gillis, G. Horn, J. B. Rawlings, and M. Diehl, “CasADi: a software framework for nonlinear optimization and optimal control,” Mathematical Programming Computation, vol. 11, pp. 1–36, 2019.
- J. Deray and J. Solà, “Manif: A micro Lie theory library for state estimation in robotics applications,” Journal of Open Source Software, vol. 5, no. 46, p. 1371, 2020.
- A. Wächter and L. T. Biegler, “On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming,” Mathematical Programming, vol. 106, pp. 25–57, 2006.