基于改进二次规划算法的X舵智能水下机器人控制分配

doi:10.16183/j.cnki.jsjtu.2020.05.010

摘要/Abstract

摘要： 针对具有4个独立舵叶的X舵智能水下机器人(AUV)姿态控制分配精度及其计算效率问题，提出一种改进二次规划算法，在满足分配精度的同时减少计算量.使用Lagrange乘子法替代序列二次规划法所用的光滑牛顿法进行优化求解计算，有效降低了迭代循环计算，同时保留了序列二次规划的计算精度.仿真环境下的X舵AUV运动控制结果表明：改进后的控制分配算法能够减少40%的计算时间，控制分配偏差不大于0.03N·m，AUV姿态控制效果良好.

关键词: X舵；智能水下机器人；控制分配；改进二次规划；运动控制

Abstract: 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 003N·m. The effect of AUV attitude control is good.

Key words: X-rudder; autonomous underwater vehicle (AUV); control allocation; improved quadratic programming; motion control

中图分类号:

TP 24

李岳明，王小平，张军军，曹建，张英浩. 基于改进二次规划算法的X舵智能水下机器人控制分配[J]. 上海交通大学学报, 2020, 54(5): 524-531.

LI Yueming,WANG Xiaoping,ZHANG Junjun,CAO Jian,ZHANG Yinghao. X-Rudder Autonomous Underwater Vehicle Control Allocation Based on Improved Quadratic Programming Algorithm[J]. Journal of Shanghai Jiaotong University, 2020, 54(5): 524-531.

参考文献

［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.

[1]	温桠妮, 颜国正, 王志武, 姜萍萍, 薛蓉蓉, 王艺芸. 肠道机器人三维接收线圈的设计与优化[J]. 上海交通大学学报, 2020, 54(11): 1117-1123.
[2]	经小龙, 胡源, 郭为忠. 臂载线结构激光手眼矩阵的精确标定——多坐标系转换法[J]. 上海交通大学学报, 2020, 54(6): 607-614.
[3]	张建军, 吴中华, 刘群坡, 王红旗, 刘卫东. 主从机械手遥操作双边自适应阻抗控制策略[J]. 上海交通大学学报, 2020, 54(6): 615-623.
[4]	张铁, 肖蒙, 邹焱飚, 肖佳栋. 基于模糊迭代算法的曲面恒力跟踪[J]. 上海交通大学学报, 2020, 54(4): 344-351.
[5]	高晋阳, 颜国正, 石云波, 刘俊. 肠道微型仿尺蠖式机器人机载供能线圈优化[J]. 上海交通大学学报, 2020, 54(2): 152-159.
[6]	蒲鹏先，颜国正，王志武，韩玎，柯全，汪炜，李达伟. 微型肠道机器人扩张机构与能量接收线圈的设计与实验[J]. 上海交通大学学报, 2019, 53(10): 1143-1150.
[7]	鲁姗，王志武，颜国正，周泽润. 仿生人工肛门括约肌假体的机构设计和实验验证[J]. 上海交通大学学报, 2019, 53(10): 1151-1158.
[8]	张建军，刘卫东，李乐，程瑞锋，郑海峰. 未知环境下水下机械手智能抓取的自适应阻抗控制[J]. 上海交通大学学报（自然版）, 2019, 53(3): 341-347.
[9]	苏程，叶佳楠，李巍，丁旺才，赵志刚. 欠约束多机协调吊运系统动力学工作空间分析[J]. 上海交通大学学报（自然版）, 2019, 53(2): 225-231.
[10]	胡兵,杨明,郭林栋,王春香,王冰. 基于地面快速鲁棒特征的智能车全局定位方法[J]. 上海交通大学学报（自然版）, 2019, 53(2): 203-208.
[11]	武文汉a,b，杨明a,b，王冰a,b，王春香c. 一种基于轮廓匹配的仓储机器人托盘检测方法[J]. 上海交通大学学报（自然版）, 2019, 53(2): 197-202.
[12]	刘亚风，王新杰，陆飞，王炅. 基于PLZT/PVDF复合驱动的光控微镜平移机构[J]. 上海交通大学学报（自然版）, 2018, 52(7): 837-844.
[13]	袁伟a,b，杨明a,b，邓琉元a,b，王春香c，王冰a,b. 基于V视差的地形高程栅格图快速构建方法[J]. 上海交通大学学报（自然版）, 2018, 52(1): 1-6.
[14]	李洋洋，史历程，万卫兵，赵群飞. 基于卷积神经网络的三维物体检测方法[J]. 上海交通大学学报（自然版）, 2018, 52(1): 7-12.
[15]	王江北，方晔阳，童歆，张帅，费燕琼. 多气囊仿生软体机器人设计及其运动特性分析[J]. 上海交通大学学报（自然版）, 2018, 52(1): 20-25.