A simplified modeling method of UVMS system dynamics based on quasi-Lagrange equation
-
摘要: 作为一种具有强非线性、强耦合、时变、冗余、高维度的复杂系统, 水下机器人-机械臂系统(Underwater Vehicle-Manipulator System, UVMS)的建模、运动控制和稳定性研究都具有较大的难度。在动力学建模中,对于自由度较高的复杂水下机器人-机械臂系统, 采用传统拉格朗日方程建模, 需要对广义坐标向量和其导数分别进行求导和求偏导操作, 会面临符号求导计算量大、建模效率低等问题。因此, 本文旨在基于类拉格朗日方法提出一种适用于
$6 + n$ 自由度水下机器人-机械臂系统的动力学简化建模方法, 减少符号化公式推导的运算量, 提高建模效率与结果的准确性。最后结合BlueROV水下机器人与Reach Alpha水下机械臂的实物参数对所建立的模型进行了数值仿真, 实验结果验证了UVMS系统的复杂耦合性。基于本文方法建立的动力学模型具有明确、清晰的方程形式, 能够为控制算法研究与耦合力优化提供有力的支撑, 为动力学参数设计与轨迹规划研究提供基础。Abstract: As a kind of complex system with strong nonlinearity, strong coupling, time variance, redundancy and high dimension, the modeling, motion control and stability analysis of an underwater vehicle-manipulator system(UVMS) are very challenging. In the dynamic modeling, the traditional Lagrange equation is used to model the complex underwater vehicle-manipulator system with high degrees of freedom, which requires the operation of differentiation and partial differentiation of the generalized coordinates and their derivatives, respectively, and will face the problems of large amount of calculation and low modeling efficiency. Therefore, this paper aims to propose a simplified dynamic modeling method for 6 + n degree-of-freedom UVMS based on the quasi-Lagrange equation, which can reduce the computational complexity of the symbolic formula derivation, and improve the modeling efficiency and the accuracy of the results. Finally, the numerical simulation of a UVMS model is carried out with the physical parameters of BlueROV and Reach Alpha underwater manipulator, and the simulation results verify the complex coupling of the UVMS system. The dynamic model based on the proposed method has a clear symbolic form, which not only provides strong support for the study of control algorithms and the optimization of coupling forces, but also a basis for the design of dynamic parameters and the study of trajectory planning.-
Key words:
- Underwater vehicle /
- Quasi-Lagrange /
- Simplified modeling /
- Simulation
-
表 1 水下机器人-机械臂相关符号说明
Table 1. Description of symbols related to an underwater vehicle-manipulator system
位置/姿态角/关节变量
(平动/转动)线速度/角速度/
关节速度力/力矩/
关节力(矩)x u X y v Y z w Z $\phi $ p K $\theta $ q M $\psi $ r N $ {\alpha _1} $ $ {\dot \alpha _1} $ ${Q_1}$ $ {\alpha _2} $ $ {\dot \alpha _2} $ ${Q_2}$ ··· ··· ··· $ {\alpha _n} $ $ {\dot \alpha _n} $ ${Q_n}$ -
[1] 杨波, 刘烨瑶, 廖佳伟. 载人潜水器——面向深海科考和海洋资源开发利用的“国之重器”[J]. 中国科学院院刊, 2021, 36(5): 622-631.YANG B, LIU Y Y, LIAO J W. Manned submersible——the most important weapon of the country for deep-sea scientific research and marine resources development and utilization[J]. Proceedings of the Chinese Academy of Sciences, 2021, 36(5): 622-631. [2] ZHANG H, ZHANG S, WANG Y, et al. Subsea pipeline leak inspection by autonomous underwater vehicle[J]. Applied Ocean Research, 2021, 107: 102321. doi: 10.1016/j.apor.2020.102321 [3] 王涛. 水下机器人ROV在石油行业的维修技术研究[J]. 中国石油和化工标准与质量, 2023, 43(19): 184-186. doi: 10.3969/j.issn.1673-4076.2023.19.059WANG T. Research on maintenance technology of ROV in petroleum industry[J]. China Petroleum and Chemical Industry Standards and Quality, 2023, 43(19): 184-186. doi: 10.3969/j.issn.1673-4076.2023.19.059 [4] LI B, WANG Y, ZHU K, et al. Structure design and control research of a novel underwater cable-driven manipulator for autonomous underwater vehicles[J]. Proceedings of the Institution of Mechanical Engineers, Part M: Journal of Engineering for the Maritime Environment, 2020, 234(1): 170-180. doi: 10.1177/1475090219851948 [5] GAO L, SONG Y, GAO J, et al. Dynamic modeling and simulation an underwater vehicle manipulator system[C]//2022 IEEE 9th International Conference on Underwater System Technology: Theory and Applications (USYS). IEEE, 2022: 1-6. [6] XIONG X, XIANG X, WANG Z, et al. On dynamic coupling effects of underwater vehicle-dual-manipulator system[J]. Ocean Engineering, 2022, 258: 111699. doi: 10.1016/j.oceaneng.2022.111699 [7] Shah U H, Karkoub M, Kerimoglu D, et al. Dynamic analysis of the UVMS: effect of disturbances, coupling, and joint-flexibility on end-effector positioning[J]. Robotica, 2021, 39(11): 1952-1980. doi: 10.1017/S0263574721000072 [8] TARN T J, SHOULTS G A, YANG S P. A dynamic model of an underwater vehicle with a robotic manipulator using Kane's method[J]. Autonomous Robots, 1996, 3(2-3): 269-283. doi: 10.1007/BF00141159 [9] HAN H, WEI Y, YE X, et al. Modeling and fuzzy decoupling control of an underwater vehicle-manipulator system[J]. IEEE Access, 2020, 8: 18962-83. doi: 10.1109/ACCESS.2020.2968063 [10] ZHU Q, SHANG H Q, LU X, et al. Adaptive sliding mode tracking control of underwater vehicle-manipulator systems considering dynamic disturbance[J]. Ocean Engineering, 2024, 291: 116300. doi: 10.1016/j.oceaneng.2023.116300 [11] SARKAR, N, PODDER T K. Coordinated motion planning and control of autonomous underwater vehicle-manipulator systems subject to drag optimization[J]. IEEE Journal of Oceanic Engineering, 2001, 26(2): 228-239. doi: 10.1109/48.922789 [12] MEIROVITCH L. Methods of analytical dynamics[M]. New York: Courier Corporation, 2010. [13] FOSSEN T I. Guidance and control of ocean vehicles[M]. Hoboken: John Wiley & Sons Inc, 1994. [14] JOHN J, CRAIG. 机器人学导论[M]. 第3版. 北京: 机械工业出版社, 2006. [15] MARAIS W J, WILLIAMS S B, PIZARRO O. Go with the flow: Energy minimising periodic trajectories for UVMS[C]//2022 International Conference on Robotics and Automation (ICRA). []: IEEE, 2022: 01-07. -