针对具有4个独立舵叶的X舵智能水下机器人(AUV)姿态控制分配精度及其计算效率问题，提出一种改进二次规划算法，在满足分配精度的同时减少计算量.使用Lagrange乘子法替代序列二次规划法所用的光滑牛顿法进行优化求解计算，有效降低了迭代循环计算，同时保留了序列二次规划的计算精度.仿真环境下的X舵AUV运动控制结果表明：改进后的控制分配算法能够减少40%的计算时间，控制分配偏差不大于0.03N·m，AUV姿态控制效果良好.
Aiming at the problem of allocation accuracy and computational efficiency of X-rudder autonomous underwater vehicle (AUV) attitude control with four independent rudder blades, an improved quadratic programming algorithm is proposed to reduce the calculation amount while satisfying the allocation accuracy. The Lagrange multiplier method is used to replace the smooth Newton method used in the sequence quadratic programming method to optimize the solution calculation. The method effectively reduces the iterative cycle calculation while preserving the calculation accuracy of sequence quadratic programming. The results of X-rudder AUV motion control in the simulation environment show that the improved control allocation algorithm can reduce the calculation time by 40%, and the control allocation deviation is not more than 003N·m. The effect of AUV attitude control is good.
［1］胡坤, 徐亦凡, 王树宗. 潜艇X舵发展概况及其操纵控制特性分析［J］.中国造船, 2007, 48(2): 130-136.
HU Kun, XU Yifan, WANG Shuzong. X rudder submarine’s development history and the analysis of it’s manipulative characteristic［J］. Ship Building of China, 2007, 48(2): 130-136.
［2］焦玉超, 肖昌润. 潜艇X舵的布局优化［J］.兵器装备工程学报, 2018, 39(3): 40-44.
JIAO Yuchao, XIAO Changrun. Layout optimization of submarine X rudder［J］. Journal of Ordnance Equipment Engineering, 2018, 39(3): 40-44.
［3］曾俊宝, 李硕, 李一平, 等. 便携式自主水下机器人控制系统研究与应用［J］. 机器人, 2016, 38(1): 91-97.
ZENG Junbao, LI Shuo, LI Yiping, et al. Research and application of the control system for a portable autonomous underwater vehicle［J］. Robot, 2016, 38(1): 91-97.
［4］焦玉超, 肖昌润. 潜艇X舵研究综述［C］//第十届武汉地区船舶与海洋工程研究生学术论坛论文集. 中国武汉: 武汉地区船舶与海洋工程研究生学术论坛, 2017: 124-130.
JIAO Yuchao, XIAO Changrun. The conceptual design of semi-submersible submarine［C］//Proceedings of the 10th Wuhan Academic Forum on Ship and Ocean Engineering. Wuhan, China: Wuhan Academic Forum for Ship and Ocean Engineering Graduate Students, 2017: 124-130.
［5］DURHAM W. Constrained control allocation: Three-moment problem［J］. Journal of Guidance, Control, and Dynamics, 1994, 17(2): 330-336.
［6］OMERDIC E,ROBERTSG N,TOAL D. Extension of feasible region of control allocation for open-frame underwater vehicles［J］. IFAC Conference on Computer Applications in Marine Systems, 2004, 37(10): 315-320.
［7］俞建成, 张艾群, 王晓辉. 基于SQP算法的7000m载人潜水器有约束非线性控制分配研究［J］. 信息与控制, 2006, 35(4): 508-512.
YU Jiancheng, ZHANG Aiqun, WANG Xiaohui. Constrained nonlinear control allocation of a 7000m manned submarine using sequential quadratic programming［J］. Information and Control, 2006, 35(4): 508-512.
［8］ZHANG Y H, LI Y M, SUN Y S, et al. Design and simulation of X-rudder AUV’s motion control［J］. Ocean Engineering, 2017, 137: 204-214.
［9］BORDINGNON K A, DURHAM W C. Closed-form solutions to constrained control allocation problem［J］. Journal of Guidance, Control, and Dynamics, 1995, 18(5): 1000-1007.
［10］隆昌菊. 伪逆矩阵与线性方程组［J］. 重庆职业技术学院学报, 2006, 15(6): 158-159.
LONG Changju. Pseudoinverse matrix and linear equation［J］. Journal of Chongqing Vocational & Technical Institute, 2006, 15(6): 158-159.
［11］马昌凤, 柯艺芬, 谢亚军. 最优化计算方法及其MATLAB程序实现［M］.北京: 国防工业出版社, 2015.
MA Changfeng, KE Yifen, XIE Yajun. Optimization calculation method and its MATLAB program implementation［M］. Beijing: National Defense Industry Press, 2015.
［12］杨立平. 舵桨联控式水下机器人容错控制技术研究［D］. 哈尔滨: 哈尔滨工程大学, 2010.
YANG Liping. Research on fault tolerant control technology of underwater vehicle controlled by rudders and thrusters［D］. Harbin: Harbin Engineering University, 2010.
