Convex Geometric Trajectory Tracking using Lie Algebraic MPC for Autonomous Marine Vehicles (2305.09009v2)
Abstract: Controlling marine vehicles in challenging environments is a complex task due to the presence of nonlinear hydrodynamics and uncertain external disturbances. Despite nonlinear model predictive control (MPC) showing potential in addressing these issues, its practical implementation is often constrained by computational limitations. In this paper, we propose an efficient controller for trajectory tracking of marine vehicles by employing a convex error-state MPC on the Lie group. By leveraging the inherent geometric properties of the Lie group, we can construct globally valid error dynamics and formulate a quadratic programming-based optimization problem. Our proposed MPC demonstrates effectiveness in trajectory tracking through extensive-numerical simulations, including scenarios involving ocean currents. Notably, our method substantially reduces computation time compared to nonlinear MPC, making it well-suited for real-time control applications with long prediction horizons or involving small marine vehicles.
- A. Sahoo, S. K. Dwivedy, and P. Robi, “Advancements in the field of autonomous underwater vehicle,” Ocean Eng., vol. 181, pp. 145–160, 2019.
- R. Zagatti, D. R. Juliano, R. Doak, G. M. Souza, L. de Paula Nardy, H. Lepikson, C. Gaudig, and F. Kirchner, “FlatFish resident AUV: leading the autonomy era for subsea oil and gas operations,” in Offshore Tech. Conf., 2018.
- W. Wang, B. Gheneti, L. A. Mateos, F. Duarte, C. Ratti, and D. Rus, “Roboat: An autonomous surface vehicle for urban waterways,” in Proc. IEEE/RSJ Int. Conf. Intell. Robots and Syst., 2019, pp. 6340–6347.
- E. I. Sarda, H. Qu, I. R. Bertaska, and K. D. von Ellenrieder, “Station-keeping control of an unmanned surface vehicle exposed to current and wind disturbances,” Ocean Eng., vol. 127, pp. 305–324, 2016.
- Z. Liu, Y. Zhang, X. Yu, and C. Yuan, “Unmanned surface vehicles: An overview of developments and challenges,” Annu. Reviews Control, vol. 41, pp. 71–93, 2016.
- Y. Cho, J. Han, and J. Kim, “Efficient COLREG-compliant collision avoidance in multi-ship encounter situations,” IEEE Trans. Intell. Transp. Syst., vol. 23, no. 3, pp. 1899–1911, 2020.
- Y. Shi and K. Zhang, “Advanced model predictive control framework for autonomous intelligent mechatronic systems: A tutorial overview and perspectives,” Annu. Reviews Control, vol. 52, pp. 170–196, 2021.
- H. Wei and Y. Shi, “MPC-based motion planning and control enables smarter and safer autonomous marine vehicles: Perspectives and a tutorial survey,” IEEE J. Autom. Sinica., 2022.
- W. Wang, L. A. Mateos, S. Park, P. Leoni, B. Gheneti, F. Duarte, C. Ratti, and D. Rus, “Design, modeling, and nonlinear model predictive tracking control of a novel autonomous surface vehicle,” in Proc. IEEE Int. Conf. Robot. and Automation, 2018, pp. 6189–6196.
- B. J. Guerreiro, C. Silvestre, R. Cunha, and A. Pascoal, “Trajectory tracking nonlinear model predictive control for autonomous surface craft,” IEEE Trans. Control Syst. Technol., vol. 22, no. 6, pp. 2160–2175, 2014.
- H. Liang, H. Li, and D. Xu, “Nonlinear model predictive trajectory tracking control of underactuated marine vehicles: Theory and experiment,” IEEE Trans. Ind. Electron., vol. 68, no. 5, pp. 4238–4248, 2020.
- W. Wang, N. Hagemann, C. Ratti, and D. Rus, “Adaptive nonlinear model predictive control for autonomous surface vessels with largely varying payload,” in Proc. IEEE Int. Conf. Robot. and Automation, 2021, pp. 7337–7343.
- A. S. Annamalai, R. Sutton, C. Yang, P. Culverhouse, and S. Sharma, “Robust adaptive control of an uninhabited surface vehicle,” J. Intell. Robot. Syst., vol. 78, pp. 319–338, 2015.
- C. Liu, C. Li, and W. Li, “Computationally efficient MPC for path following of underactuated marine vessels using projection neural network,” Neural Comput. Appl., vol. 32, pp. 7455–7464, 2020.
- C. Shen and Y. Shi, “Distributed implementation of nonlinear model predictive control for AUV trajectory tracking,” Automatica, vol. 115, p. 108863, 2020.
- S. Teng, W. Clark, A. Bloch, R. Vasudevan, and M. Ghaffari, “Lie algebraic cost function design for control on Lie groups,” in Proc. IEEE Conf. Decision Control, 2022, pp. 1867–1874.
- M. Ghaffari, R. Zhang, M. Zhu, C. E. Lin, T.-Y. Lin, S. Teng, T. Li, T. Liu, and J. Song, “Progress in symmetry preserving robot perception and control through geometry and learning,” Frontiers in Robotics and AI, vol. 9, pp. 1–30, 2022.
- X. He and Z. Geng, “Point stabilization and trajectory tracking of underactuated surface vessels: A geometric control approach,” J. Franklin Inst., vol. 358, no. 14, pp. 7119–7141, 2021.
- M. Tayefi and Z. Geng, “Logarithmic control, trajectory tracking, and formation for nonholonomic vehicles on Lie group SE(2),” Int. J. Control, vol. 92, no. 2, pp. 204–224, 2019.
- 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 Proc. IEEE/RSJ Int. Conf. Intell. Robots and Syst., 2022, pp. 8850–8857.
- T. I. Fossen and T. Perez, “Marine systems simulator (MSS),” 2004. [Online]. Available: {https://github.com/cybergalactic/MSS}
- J. Sola, J. Deray, and D. Atchuthan, “A micro Lie theory for state estimation in robotics,” arXiv preprint arXiv:1812.01537, 2018.
- A. Bloch, P. Krishnaprasad, J. E. Marsden, and T. S. Ratiu, “The Euler-Poincaré equations and double bracket dissipation,” Commun. Math. Phys., vol. 175, no. 1, pp. 1–42, 1996.
- A. Barrau and S. Bonnabel, “The invariant extended Kalman filter as a stable observer,” IEEE Trans. Autom. 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,” Math. Program. Comput., vol. 12, no. 4, pp. 637–672, 2020.
- J. A. E. Andersson, J. Gillis, G. Horn, J. B. Rawlings, and M. Diehl, “CasADi – A software framework for nonlinear optimization and optimal control,” Math. Program. Comput., vol. 11, no. 1, pp. 1–36, 2019.
- M. J. Risbeck and J. B. Rawlings, “MPCTools: Nonlinear model predictive control tools for CasADi (Octave interface)”, 2016
- R. Tedrake, I. R. Manchester, M. Tobenkin, and J. W. Roberts, “Lqr- trees: Feedback motion planning via sums-of-squares verification,” The International Journal of Robotics Research, vol. 29, no. 8, pp. 1038– 1052, 2010.
- H. Zheng, J. Wu, W. Wu, and Y. Zhang, “Robust dynamic positioning of autonomous surface vessels with tube-based model predictive control,” Ocean Eng., vol. 199, p. 106820, 2020.