[1]樊 智 敏,哈 振 骞,薛 福 峰,等.水下机械臂运动空间分析与轨迹跟踪算法优化[J].机械与电子,2020,(06):67-73.
　,,et al.Underwater Manipulator Motion Spatial Analysis and TrackingAlgorithm Optimization[J].Machinery & Electronics,2020,(06):67-73.
点击复制

水下机械臂运动空间分析与轨迹跟踪算法优化()
分享到：

机械与电子[ISSN:1001-2257/CN:52-1052/TH]

卷:
期数:
2020年06期
页码:
67-73
栏目:
智能工程
出版日期:
2020-06-24

文章信息/Info

Title:
Underwater Manipulator Motion Spatial Analysis and TrackingAlgorithm Optimization
文章编号:
1001-2257(2020)06-0067-07
作者:
樊 智 敏 ; 哈 振 骞 ; 薛 福 峰 ; 王 明 凯
 青岛科技大学机电工程学院，山东青岛 266061

Author(s):
ＦＡＮ Ｚｈｉｍｉｎ ;  ＨＡ Ｚｈｅｎｑｉａｎ ;  ＸＵＥ Ｆｕｆｅｎｇ ;  Ｗ ＡＮ Ｇ Ｍｉｎｇｋａｉ
Ｃｏｌｌｅｇｅ ｏｆ Ｅｌｅｃｔｒｏ ｍｅｃｈａｎｉｃａｌ Ｅｎｇｉｎｅｅｒｉｎｇ ， Ｑｉｎｇｄａｏ Ｕ ｎｉｖｅｒｓｉｔｙ ｏｆ Ｓｃｉｅｎｃｅ ａｎｄ Ｔｅｃｈｎｏｌｏｇｙ ， Ｑｉｎｇｄａｏ ２６６０６１ ， Ｃｈｉｎａ
关键词:
水下机械臂; 蒙特卡洛法; 运动空间; 径向基函数神经网络; 轨迹跟踪
Keywords:
underwater manipulator; Monte Carlo method; motion space; radial basis function neural network; trajectory tracking

' target="_blank" rel="external"> VERTICAL-ALIGN: middle">

分类号:
Ｔ Ｐ２４１
文献标志码:
A
摘要:
 针对水下机械臂动力学模型不确定和未知外界干扰问题，采用基于HJI理论的径向基函数神经网络自适应控制算法对水下机械臂进行控制。首先，以水下六自由度机械臂为例，基于D-H法则对水下机械臂的运动学进行分析，通过仿真验证该方法的正确性；接着，基于蒙特卡洛法构建水下六自由度机械臂的运动空间云图，真实反映水下机械臂的运动空间；然后，以二自由度水下机械臂为例，设计基于HJI理论的RBF神经网络自适应控制器，利用神经网络的万能逼近原理逼近不确定干扰项，考虑到神经网络逼近存在误差，将逼近误差看作外界干扰项并通过HJI理论对逼近误差在线评价，评价系统对干扰项的抑制能力，并采用自适应算法在线估计网络权值，加快系统收敛；最后，通过仿真可知，该机械臂能较好地完成轨迹跟踪。
Abstract:
 Anadaptive control algorithm, based on Hamiltion-Jacobi Inequality (HJI) radial basis function(RBF) neural network, was introduced tocontrol the robotic armunderwaterwhere uncertain dynamic model and unknown external interference mayoccur. First, an underwater six-degree-of-freedom robotic arm was taken as an example. The kinematics of the underwater mechanical arm was analyzed based on the DH rule, and the correctness of the method was verified by simulation. Then, a six-degree-of-freedom underwater robot was constructed based on the Monte Carlo method. The cloud image of the arm’s motion space truly reflected the motion space of the underwater robotic arm. Finally, a two-degree-of-freedom robotic arm was taken as another example, and an RBF neural network adaptive controllerwas designed based on HJI theory.The universal approximation principle of the neural network was applied to uncertain interference terms. Due to the existence of errors in the neural network approximation, the approximation errors were taken as external interference terms and the approximation errors online were evaluatedusing HJI theory, the system’s ability to suppress the interference termswas also evaluated,and an adaptive algorithm was applied to estimate the network weight online to accelerate the system convergence.It concludes that the trajectory tracking can be achieve better through simulation.

参考文献/References:

［ １ ］ 　Ｆ Ｅ Ｒ Ｎ Ａ Ｎ Ｄ ＥＺ Ｊ Ｊ ， Ｐ Ｒ Ａ Ｔ Ｓ Ｍ ， Ｓ Ａ Ｎ Ｚ Ｐ Ｊ ， ｅｔ ａｌ．Ｇｒａｓｐｉｎｇ ｆｏｒ ｔｈｅ ｓｅａｂｅｄ ： ｄｅｖｅｌｏｐｉｎｇ ａ ｎｅｗ ｕｎｄｅｒｗａｔｅｒ ｒｏｂｏｔ ａｒｍ ｆｏｒ ｓｈａｌｌｏｗ ｗａｔｅｒ ｉｎｔｅｒｖｅｎｔｉｏｎ ［ Ｊ ］ ．ＩＥ Ｅ Ｅ Ｒｏｂｏｔｉｃｓ ａｎｄ Ａ ｕｔｏ ｍａｔｉｏｎ Ｍ ａｇｚｉｎｅ ， ２０１３ ， ２０ （ ４ ）： １２１- １３０ ．
［ ２ ］ 　ＳＡ ＮＺ Ｐ Ｊ ， ＰＥ Ｎ Ａ Ｌ Ｖ Ｅ Ｒ Ａ ， ＳＡ ＬＥＳ Ｊ ， ｅｔ ａｌ．Ｇｒａｓｐｅｒ ： ａｍｕｌｔｉｓｅｎｓｏｒｙ ｂａｓｅｄ ｍａｎｉｐｕｌａ ｔｉｏｎ ｓｙｓｔｅｍ ｆｏｒ ｕｎｄｅｒｗａｔｅｒｏｐｅｒａｔｉｏｎｓ ［ Ｃ ］／／ ２０１３ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｓｙｓｔｅｍｓ ， Ｍ ａｎ ， ａｎｄ Ｃｙｂｅｒｎｅｔｉｃｓ ， ２０１３ ： ４０３６- ４０４１ ．
［ ３ ］ 　Ｂ Ｕ Ｒ Ｇ Ｕ Ｅ Ｒ Ａ Ａ ， Ｂ Ｏ ＮＩＮＦ Ｏ Ｎ Ｔ Ｆ ， Ｏ ＬＩＶ Ｅ Ｒ Ｇ ．Ｔｒａｊｅｃｔｏｒｙ ｂａｓｅｄ ｖｉｓｕａｌ ｌｏｃａｌｉｚａｔｉｏｎｉｎ ｕｎｄｅｒｗａｔｅｒ ｓｕｒｖｅｙｉｎｇ ｍｉｓｓｉｏｎ ［ Ｊ ］ ．Ｓｅｎｓｏｒｓ ， ２０１５ ， １５ （ １ ）： １７０８- １７３５ ．
［ ４ ］ 　 黄 海 ，张 国 成 ，杨 溢 ． 水 下 无 人 航 行 器 机 械 手 系 统 动 力学 建 模 与 协 调 运 动 轨 迹 优 化 ［ Ｊ ］ ． 上 海 交 通 大 学 学 报 ，２０１６ ， ５０ （ ９ ）： １４３７- １４４３ ， １４５１ ．
［ ５ ］ 　Ｚ Ｈ Ａ Ｎ Ｇ Ｊ Ｈ ， Ｙ Ｕ Ａ Ｎ Ｊ ， Ｓ Ｕ Ｎ Ｌ Ｙ ， ｅｔ ａｌ．Ｋｉｎｅｍａｔｉｃｓ ａｎａｌｙｓｉｓ ｏｆｔｈｅ ４ Ｄ Ｏ Ｆ ｕｎｄｅｒｗａｔｅｒ ｍａｎｉｐｕｌａｔｏｒ ｓｅｒｖｅｄ ｆｏｒ ｎｕｃｌｅａｒ ｐｏｗｅｒ ｐｌａｎｔ ［ Ｃ ］／／ ＩＥＥＥ Ｉｎｔｅｒｎａｔｉｏｎａｌ Ｃｏｎｆｅｒｅｎｃｅ ｏｎ Ｒｏｂｏｔｉｃｓ ａｎｄ Ｂｉｏｍｉｍｅｔｉｃｓ ， ２０１３ ： ２７４４- ２７５３ ．
［ ６ ］ 　 李 保 丰 ，孙 汉 旭 ，贾 庆 轩 ，等 ． 基 于 蒙 特 卡 罗 法 的 空 间 机 器人 工 作 空 间 计 算 ［ Ｊ ］ ． 航 天 器 工 程 ， ２０１１ ， ２０ （ ４ ）： ７９-８５ ．
［ ７ ］ 　 黄 贤 振 ． 基 于 蒙 特 卡 洛 法 六 自 由 度 机 械 臂 工 作 空 间 研究 ［ Ｊ ］ ． 装 备 制 造 技 术 ， ２０１６ （ １０ ）： ４３-
４５ ．
［ ８ ］ 　 何 价 来 ，罗 金 良 ， 宦 朋 松 ，等 ． 基 于 蒙 特 卡 洛 法 的 七 自由 度 拟 人 机 械 臂 工 作 空 间 分 析 ［ Ｊ ］ ． 组 合 机 床 与 自 动 化加 工 技 术 ， ２０１５ （ ３ ）： ４８-５１ ．
［ ９ ］ 　 韩 冬 梅 ． 基 于 蒙 特 卡 洛 方 法 高 压 水 破 拆 机 器 人 机 械 臂工 作 空 间 的 研 究 ［ Ｊ ］ ． 智 能 城 市 ， ２０１７ ， ３ （ ５ ）： ４１-４３ ．
［ １０ ］ 　 赵 克 楠 ． 水 液 压 驱 动 的 水 下 机 械 手 及 其 模 糊 ＰＩＤ 控 制方 法 研 究 ［ Ｄ ］ ． 哈 尔 滨 ：哈 尔 滨 工 程 大 学 ， ２０１４ ．
［ １１ ］ 　Ｌ Ｏ Ｎ Ｄ Ｈ Ｅ Ｐ Ｓ ， Ｍ Ｏ Ｈ Ａ Ｎ Ｓ ， Ｐ Ａ Ｔ Ｒ Ｅ Ｂ Ｍ ， ｅｔ ａｌ． Ｒｏｂｕｓｔ ｔａｓｋ ｓｐａｃｅ ｃｏｎｔｒｏｌ ｏｆ ａｎ ａｕｔｏｎｏ ｍ ｏｕｓ ｕｎｄｅｒｗａｔｅｒ ｖｅｈｉｃｌｅ ｍａｎｉｐｕｌａｔｏｒ ｓｙｓｔｅｍ ｂｙ ＰＩＤ ｌｉｋｅ ｆｕｚｚｙ
ｃｏｎｔｒｏｌ ｓｃｈｅｍｅ ｗｉｔｈ ｄｉｓｔｕｒｂａｎｃｅ ｅｓｔｉｍａｔｏｒ ［ Ｊ ］ ．Ｏｃｅａｎ Ｅｎｇｉｎｅｅｒｉｎｇ ， ２０１７ ， １３９ ： １-１３ ．
［ １２ ］ 　ＦＩＬ Ａ Ｒ Ｅ Ｔ Ｏ Ｖ Ｖ Ｆ ， Ｋ Ｏ Ｎ Ｏ ＰＬＩＮ Ａ Ｙ ．Ｓｙｓｔｅｍ ｏｆ ａｕｔｏ ｍａｔｉｃａｌｌｙ ｃｏｒｒｅｃｔｉｏｎ ｏｆ ｐｒｏｇｒａｍ ｔｒａｊｅｃｔｏｒｙ ｏｆ ｍ ｏｔｉｏｎ ｏｆ ｍ ｕｌｔｉｌｉｎｋ ｍａｎｉｐｕｌａｔｏｒｉｎｓｔａｌｌｅｄ ｏｎ ｕｎｄｅｒｗａｔｅｒ ｖｅｈｉｃｌｅ ［ Ｊ ］ ． Ｐｒｏｃｅｄｉａ Ｅｎｇｉｎｅｅｒｉｎｇ ， ２０１５ ， １００ ： １４４１- １４４９ ．
［ １３ ］ 　Ｂ Ａ ＲＢ Ａ Ｌ ＡＴＡＣ ， Ｄ Ｕ Ｎ ＮＩＧ Ａ Ｎ Ｍ Ｗ ， ＰＥ ＴＩＬＬ Ｏ Ｔ Ｙ Ｒ ．Ｐｏｓｉｔｉｏｎ ／ ｆｏｒｃｅ ｏｐｅｒａｔｉｏｎａｌ ｓｐａｃｅ ｃｏｎｔｒｏｌ ｆｏｒ ｕｎｄｅｒｗａｔｅｒ ｍａｎｉｐｕｌａｔｉｏｎ ［ Ｊ ］ ．Ｒｏｂｏｔｉｃｓ ａｎｄ Ａｕｔｏｎｏｍｏｕｓ Ｓｙｓｔｅｍｓ ，２０１８ ， １００ ： １５０- １５９ ．
［ １４ ］ 　 陈 显 亭 ，王 海 波 ，贾 晓 飞 ． 水 下 机 械 臂 的 复 合 控 制 策 略研 究 ［ Ｊ ］ ． 武 汉 理 工 大 学 学 报 ， ２０１０ ， ３２ （ １ ）： ９０-９３ ．
［ １５ ］ 　 邱 红 祥 ． 全 海 深 液 压 机 械 手 粘 压 特 性 补 偿 及 变 增 益 控制 研 究 ［ Ｄ ］ ． 杭 州 ：浙 江 大 学 ， ２０１８ ．
［ １６ ］ 　 王 亚 猛 ． 水 液 压 驱 动 的 水 下 机 械 臂Ｐ Ｗ Ｍ鲁 棒 控 制 研究 ［ Ｄ ］ ． 武 汉 ：华 中 科 技 大 学 ， ２０１１ ．
［ １７ ］ 　 秦 耀 昌 ． 基 于 终 端 滑 模 的 水 下 机 械 手 运 动 控 制 技 术 研究 ［ Ｄ ］ ． 哈 尔 滨 ：哈 尔 滨 工 程 大 学 ， ２０１２ ．
［ １８ ］ 　Ｅ Ａ Ｂ Ｏ Ｕ Ｒ Ｎ Ｅ Ｋ Ｎ ． Ｔ ｗｏ ｌｉｎｋ ｈｙｄｒｏｄｙｎａｍｉｃ ｍ ｏｄｅｌ ｄｅｖｅｌｏｐ ｍｅｎｔ ａｎｄ ｍ ｏｔｉｏｎ ｐｌａｎｎｉｎｇ ｆｏｒ ｕｎｄｅｒｗａｔｅｒ ｍａｎｉｐｕｌａｔｉｏｎ ［ Ｄ ］ ．Ｓｔａｎｆｏｒｄ ： Ｓｔａｎｆｏｒｄ Ｕ ｎｉｖｅｒｓｉｔｙ ， ２００１ ．

相似文献/References:

[1]赵彦飞,田军委,裴 蕾,等.水下机械臂设计[J].机械与电子,2017,(06):77.
　ZHAO Yanfei,TIAN Junwei,PEI Lei,et al.Design of Underwater Manipulator[J].Machinery & Electronics,2017,(06):77.
[2]魏延辉,陈巍,杨子扬,等.基于构形平面的水下机械臂运动学求解方法[J].机械与电子,2016,(03):3.
　WEI Yanhui,CHEN Wei,YANG Ziyang,et al.Kinematics Solution Approach for Underwater Manipulator Based on Configuration Plane[J].Machinery & Electronics,2016,(06):3.
[3]苏 宇,张 吉,王 沁.轻量级电驱水下机械臂设计与运动学分析[J].机械与电子,2020,(03):66.
　,Design and Kinematic Analysis of a Lightweight Electric Drive Underwater Manipulator[J].Machinery & Electronics,2020,(06):66.

备注/Memo

备注/Memo:
收 稿 日 期 ： ２０２０-０２- ２６
基 金 项 目 ：山 东 省 重 点 研 发 计 划 项 目 （ ２０１９ Ｇ Ｇ Ｘ１０４０８８ ）
作 者 简 介 ：樊 智 敏 　 （ １９６３ － ），男 ，山 东 青 岛 人 ，博 士 ，教 授 ，博 士 研 究 生 导 师 ，研 究 方 向 为 机 械 传 动 设 计 理 论 与 方 法 等 。
更新日期/Last Update: 2020-06-24