面向海底光学探测使命的自治水下机器人水平路径跟随控制

doi:10.3969/j.issn.1000-1093.2017.06.014

兵工学报 ›› 2017, Vol. 38 ›› Issue (6): 1147-1153.doi: 10.3969/j.issn.1000-1093.2017.06.014

面向海底光学探测使命的自治水下机器人水平路径跟随控制

马艳彤^1,2，郑荣¹，韩晓军¹

(1.中国科学院沈阳自动化研究所机器人学国家重点实验室，辽宁沈阳 110016； 2.东北大学机械工程与自动化学院，辽宁沈阳 1108191)

收稿日期:2016-10-11 修回日期:2016-10-11 上线日期:2017-12-15
作者简介:马艳彤（1991—），女，硕士研究生。E-mail: mayantong@sia.cn
基金资助:
中国科学院国防科技创新基金项目（CXJJ-16M221）

Horizontal Trajectory Tracking Control of Autonomous Underwater Vehicle Based on Seabed Optical Detection Mission

MA Yan-tong^1,2， ZHENG Rong¹， HAN Xiao-jun¹

(1.State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, Liaoning, China; 2.School of Mechanical Engineering and Automation, Northeastern University, Shenyang 110819, Liaoning, China)

Received:2016-10-11 Revised:2016-10-11 Online:2017-12-15

摘要/Abstract

摘要： 针对利用光学探测设备对海底目标探测与搜索的使命，自治水下机器人（AUV）需具备更精确的航行控制性能，为此提出一种不依赖模型的改进型PID控制算法，通过对增设的左右水平推进器进行控制，以实现AUV低速时水平面的精确航行。将整个控制器分为两层：内层为偏航距离PID控制器，将输出量转化为所需偏转角；外层为航向PID控制器，将内层计算结果转化为航向偏差，对其进行PID计算，输出为偏转所需推力和推力矩值。通过对设定探测路线进行路径跟随，以反映水平面航行控制精度。通过湖上试验，得出精确的路径跟随航迹，实现了航向角偏差均值为0.09°、航向距离偏差均方差为0.29 m的航行稳定控制，验证了该控制方法的可行性。

关键词: 控制科学与技术, 自治水下机器人, 海底光学探测, 改进型PID, 路径跟随, 水平推进器

Abstract: Autonomous underwater vehicles (AUVs) need to be provided with more accurate navigation control due to the limited operating range of optical detection device for detecting the seabed. An improved bilayer PID control algorithm which is independent of the object model is proposed. By controlling the channel propellers which are retrofitted to flanks around AUV, the controller can achieve AUV precise navigation control at low speed. The controller consists of two layers: the inner layer is a PID controller for distance deviation computation, which converts the output to desired deflection angle; the outer layer is a PID controller which computes the desired thrust and torque by inputting the output value of inner layer. The horizontal navigation precision can be reflected by tracking the planned detection route. The precise tracking path was obtained in lake trial. The mean value of course angular deviation is 0.09 °, and the mean square errors of deviation from the course is 0.29 m, which verifies the feasibility of the control scheme. Key

Key words: controlscienceandtechnology, autonomousunderwatervehicle, seabedopticaldetection, improvedPID, trajectorytracking, horizontalpropeller

中图分类号:

TP273⁺.1

马艳彤，郑荣，韩晓军. 面向海底光学探测使命的自治水下机器人水平路径跟随控制[J]. 兵工学报, 2017, 38(6): 1147-1153.

MA Yan-tong， ZHENG Rong， HAN Xiao-jun. Horizontal Trajectory Tracking Control of Autonomous Underwater Vehicle Based on Seabed Optical Detection Mission[J]. Acta Armamentarii, 2017, 38(6): 1147-1153.

参考文献

［1］徐玉如, 李彭超. 水下机器人发展趋势［J］. 自然杂志, 2011, 33(3):125-132.
XU Yu-ru, LI Peng-chao. The development of underwater robots［J］. Chinese Journal of Nature, 2011, 33(3):125-132.(in Chinese)
［2］ Fillinger L, Hunter A J, Zampolli M, et al. Passive acoustic detection of closed-circuit underwater breathing apparatus in an operational port environment［J］. Acoustical Society of America, 2012, 132(4):310-315.
［3］孙传东, 陈良益, 高立民. 水的光学特性及其对水下成像的影响［J］. 应用光学, 2000, 21(4):39-46.
SUN Chuan-dong, CHEN Liang-yi, GAO Li-min. Water optical properties and their effect on underwater imaging［J］. Journal of Applied Optics, 2000, 21(4):39-46. (in Chinese)

［4］郑荣, 马艳彤, 张斌. 基于垂向推进方式的AUV低速近底稳定航行［J］. 机器人, 2016, 38(5):588-592.
ZHENG Rong, MA Yan-tong, ZHANG Bin. AUV's near-bottom and low-speed sailing stability control based on vertical thruster［J］. Robot, 2016, 38(5):588-592. (in Chinese)

［5］ Lionel L,Didik S. Nonlinear path-following control of an AUV［J］. Ocean Engineering, 2007, 34(11/12):1734-1744.
［6］ Silvestre C, Pascoal A. Control of the INFANTE AUV using gain scheduled static output feedback［J］. Control Engineering Practice, 2004, 12(12):1501-1509.
［7］ Repoulias F, Papadopoulos E. Planar trajectory planning and tracking control design for underactuated AUVs［J］. Ocean Engineering, 2007, 34(11/12):1650-1667.
［8］ Bidyadhar S. Debabrata A. Design of a path following controller for an underactuated AUV［J］. Archives of Control Sciences, 2009, 19( 3): 245-259.
［9］ Khodayari M H, Balochian S. Modeling and control of autonomous underwater vehicle (AUV) in heading and depth attitude via self-adaptive fuzzy PID controller［J］. Journal of Marine Science and Technology, 2015, 20（3）:559-578.

［10］付江锋, 严卫生, 赵涛. 欠驱动AUV的直线航迹跟踪控制［J］. 计算机仿真, 2009, 26(10):145-147.
FU Jiang-feng, YAN Wei-sheng, ZHAO Tao. Line tracking control of underactuated AUV［J］. Computer Simulation, 2009, 26(10): 145-147. (in Chinese)

［11］万磊, 崔士鹏, 张国成, 等. 欠驱动水下机器人航迹跟踪控制［J］. 电机与控制学报, 2013, 17(2):103-110.
WANG Lei, CUI Shi-peng, ZHANG Guo-cheng, et al. Path following control of underactuated autonomous underwater vehicles ［J］. Electric Machines and Control, 2013, 17(2):103-110. (in Chinese)
［12］ Wang B, Su Y M, Wan L, et al. Adaptive PID control system for an autonomous underwater vehicle［J］. High Technology Letter, 2011, 17(1):7-12.
［13］ Chen Q, Chen T, Zhang Y. Research of GA based PID for AUV motion control［C］∥Proceedings of the 2009 IEEE International Conference on Mechatronics and Automation.Changchun: IEEE, 2009:4446-4451.
［14］陈世利, 卫民, 李一博. 基于双闭环的矢量推进器的AUV 转向控制方法［J］. 天津大学学报:自然科学与工程技术版, 2014, 47(6):530-534.
CHEN Shi-li, WEI Min, LI Yi-bo. Steering control strategy of AUV with vectored thruster based on double-loop mode ［J］. Journal of Tianjin University :Science and Technology, 2014, 47(6): 530-534. (in Chinese)
［15］晏亮, 赵琳, 程建华. 潜艇操纵运动的舵效仿真研究［J］. 计算机仿真, 2009, 26(7):12-15.
YAN Liang, ZHAO Lin, CHENG Jian-hua. Rudder effects simulation of submarine maneuvering motion ［J］.Computer Simulation, 2009, 26(7):12-15. (in Chinese)

［16］王芳, 万磊, 李晔. 欠驱动AUV的运动控制技术综述［J］.中国造船, 2010, 51(2):227-241.
WANG Fang, WAN Lei, LI Ye. Asurvey on development of motion control for underactuated AUV［J］. Shipbuilding of China, 2010, 51(2):227-241. (in Chinese)

［17］刘健, 于闯, 刘爱民. 无缆自治水下机器人控制方法研究［J］.机器人, 2004, 26(1):7-10.
LIU Jian, YU Chuang, LIU Ai-min. Research on untethered autonomous underwater vehicle control method［J］. Robot, 2004, 26(1):7-10.(in Chinese)

第38卷
第6期2017 年6月兵工学报ACTA
ARMAMENTARIIVol.38No.6Jun.2017

[1]	修杨，邓宏彬，危怡然，李东方. 基于参数估计的四旋翼无人机自适应鲁棒路径跟随控制器[J]. 兵工学报, 2022, 43(8): 1926-1938.
[2]	苗建明，王少萍，范磊，李元. 欠驱动自主水下航行器空间曲线路径跟踪控制研究[J]. 兵工学报, 2017, 38(9): 1786-1796.
[3]	查峰，覃方君，李京书，叶斌. 三轴旋转惯性导航系统的旋转控制建模研究[J]. 兵工学报, 2017, 38(8): 1610-1618.
[4]	伍明，张国良，李琳琳，付光远，李承剑. 基于动态和静态环境对象观测一致性约束的移动机器人多传感器标定优化方法[J]. 兵工学报, 2017, 38(8): 1630-1641.
[5]	王世峰，都凯悦，孟颖，王锐. 基于机器学习的车辆路面类型识别技术研究[J]. 兵工学报, 2017, 38(8): 1642-1648.
[6]	周荻，董金鲁. 带襟翼的飞行器非线性控制系统分析和设计[J]. 兵工学报, 2017, 38(7): 1322-1329.
[7]	郑睿，赵伟，方明星，杜友武. 基于多圈环绕结构的超流体陀螺噪声抑制方法[J]. 兵工学报, 2017, 38(7): 1330-1335.
[8]	邢丽, 熊智, 刘建业, 杭义军. 基于对偶四元数的圆锥及划船误差补偿改进算法[J]. 兵工学报, 2017, 38(7): 1336-1347.
[9]	庞辉, 陈嘉楠, 刘凯. 汽车磁流变半主动悬架系统自适应反推跟踪控制[J]. 兵工学报, 2017, 38(7): 1430-1442.
[10]	陈慧岩，陈舒平，龚建伟. 智能汽车横向控制方法研究综述[J]. 兵工学报, 2017, 38(6): 1203-1214.
[11]	廖自力，阳贵兵，高强，袁东. 多轮独立电驱动车辆转向稳定性集成控制研究[J]. 兵工学报, 2017, 38(5): 833-842.
[12]	王斌锐，沈国阳，金英连，王凌. 基于干扰观测器的级联气动肌肉肘关节滑模控制[J]. 兵工学报, 2017, 38(4): 793-801.
[13]	李阁强，顾永升，李健，李跃松，郭冰菁. 被动式电液力伺服系统的自适应反步滑模控制[J]. 兵工学报, 2017, 38(3): 616-624.
[14]	周焕银, 刘亚平，胡志强，刘开周, 衣瑞文. 基于辨识模型集的无人半潜水下机器人系统深度动态滑模控制切换策略研究[J]. 兵工学报, 2017, 38(11): 2198-2206.
[15]	江梦洁，李家旺，吕艳芳，周家炜，黄汉涛. 饱和输入限制下欠驱动自主水下航行器水平面航迹跟踪控制[J]. 兵工学报, 2017, 38(11): 2207-2213.

面向海底光学探测使命的自治水下机器人水平路径跟随控制

Horizontal Trajectory Tracking Control of Autonomous Underwater Vehicle Based on Seabed Optical Detection Mission

PDF

可视化

被引次数

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价