水下机器人推力分配将控制器给出的目标推力与力矩通过算法分配给各个推进器。针对水下机器人推力分配后推进器饱和问题，采用可行方向法对推力分配问题进行求解。根据推进器的空间布置情况建立通用的水下机器人推进系统数学模型。在此模型的基础上，将推力分配抽象为二次规划，利用单纯形法寻找可行的下降方向，通过一维搜索寻找最优步长。最后建立算法模型，仿真验证可行方向法和传统的伪逆法和的推力分配结果。仿真结果表明，相对传统算法，可行方向法能够更加有效地解决推力分配的饱和问题。
The thrust allocation of underwater robot allocates the target thrust and torque given by the controller to each propeller by algorithm. Aiming at the thruster saturation problem of underwater robot after thrust allocation, the feasible direction method is used to solve the thrust allocation problem. Firstly, a general mathematical model of underwater vehicle propulsion system is established according to the space arrangement of the propeller. On the basis of this model, the thrust allocation is abstracted into quadratic programming, the feasible descent direction is obtained by simplex method, and the optimal step length is acquired by one-dimensional search. Finally, the algorithm model is established to verify the thrust allocation results of feasible direction method and traditional pseudo inverse method. The simulation results show that the feasible direction method can solve the saturation problem of thrust allocation more effectively than the traditional algorithm.
2022,44(13): 102-106 收稿日期：2021-09-18
DOI：10.3404/j.issn.1672-7649.2022.13.023
分类号：TP242.6
作者简介：程卫平(1997-),男,硕士研究生,研究方向为水下机器人运动控制
参考文献：
[1] 平伟, 马厦飞, 张金华, 等. “海马”号无人遥控潜水器[J]. 舰船科学技术, 2017, 39(15): 138–141+145
[2] 任峰, 张莹, 张丽婷, 等. “海龙Ⅲ”号ROV系统深海试验与应用研究[J]. 海洋技术学报, 2019, 38(2): 30–35
[3] JOHANSEN T A, FOSSEN T I. Control allocation—A survey[J]. Automatica, 2013, 49(5): 1087–1103
[4] 李新飞, 马强, 袁利毫, 等. 矢量推进水下机器人的推力分配方法[J]. 哈尔滨工程大学学报, 2018, 39(10): 1605–1611
[5] 魏延辉, 陈巍, 杜振振, 等. 深海ROV伺服控制方法研究及其仿真[J]. 控制与决策, 2015, 30(10): 1785–1790
[6] 李新飞, 马强, 袁利毫, 等. 作业型ROV矢量推进建模及推力分配方法[J]. 船舶力学, 2020, 24(3): 332–341
[7] JOHANSSON B, SIESJö J, FURUHOLMEN M. Seaeye Sabertooth A Hybrid AUV/ROV offshore system[C]//Oceans 2010 MTS/IEEE Seattle. 2010: 1–3.
[8] FOSSEN T I. Marine control systems[M]. Trondheim: Tapir Trykkeri, 2002.
[9] FOSSEN T I. Handbook of marine craft hydrodynamics and motion control[M]. John Wiley & Sons, Ltd, 2011.
[10] 陈宝林. 最优化理论与算法[M]. 北京: 清华大学出版社, 2005.
