七功能机械手非线性鲁棒控制方法研究解读.doc

PAGE 68 机 械 工 程 学 报 第39卷第2期期 月 浙 江 大 学 学 报（工学版） 基金项目：国家高技术研究发展计划（863计划）4500米级深海作业系统，项目编号：2008AA092301 通讯作者：罗高生，E-mail: kendysnow@zju.edu.cn 学科代码：460?45 七功能液压机械手多输入多输出非线性鲁棒控制方法研究 罗高生 顾临怡 （浙江大学流体动力与机电系统国家重点实验室，浙江省 杭州 310027） 摘 要：针对液压驱动的七功能主从液压机械手具有强非线性、未知外界干扰以及机械手多刚体系统与液压驱动系统强耦合的多输入多输出控制系统特性，提出了利用backstepping控制器设计方法和基于滑模控制的多输入多输出鲁棒控制器方法，使用李雅普诺夫稳定性定理证明闭环系统具有渐近稳定的控制性能。利用4500米深海主从液压机械手作为仿真模型和实验对象进行仿真和实验研究表明，所提出的控制方法具有很???的跟踪性能和鲁棒性。 关键词：七功能液压机械手；多输入多输出鲁棒控制；Backstepping；李雅普诺夫稳定性 中图分类号： 文献标识码： Research on Nonlinear Robust Adaptive Control of Double-screw-pair Driven elbow of 7-fun hydraulic manipulator LUO Gao-sheng GU Lin-yi （The State Key Lab of Fluid Power Transmission and Control, Zhejiang University, Hangzhou 310027, China） Abstract：for control characters of double-screw-pair driven elbow of 7-fun hydraulic manipulator with strong nonlinearity of hydraulic system, parameter uncertainties by temperature and pressure change of outer environment and unknown outer disturbance, a full state feedback robust adaptive control method was presented, with the combination of backstepping controller design method and robust adaptive method, and with the advantage of Lyapunov stability theory to prove the asymptotic stability of the control system with uncertainty disturbance. Simulation and experiments shows that the presented full state feedback robust adaptive controller has satisfied control character and robustness. Keywords：elbow of 7-fun hydraulic manipulator; full state feedback robust adaptive control; backstepping; Lyapunov stability 功能、六自由度液压机械手是一个高度耦合的多输入多输出非线性系统，各关节的运动力相互作用、相互耦合；机械手系统中的柯氏力和离心力与各关节的速度成平方关系，具有很强的非线性；六自由度机械手从手的多刚体系统再加上各关节的液压驱动系统，机械从手系系统与液压系统相互强耦合；另外，机械手的多刚体模型是非常的复杂，各关节的惯性张量、关节所受的摩擦力等均无法精确得到，因此很难对液压驱动的机械手的多刚体系统进行精确建模。 未加入执行器动态的机械手机械手控制系统已经有相当的研究了，如基于PD的控制方法[103~105]，计算力矩的控制方法[106]，基于无源的控制方法[107][108][109],自适应控制方法[110]和鲁棒控制的方法[111][112]。但是如果加入执行器的动态，那么系统的阶数由原来的二阶系统变成了四阶系统，而且执行器的动态和机械手多刚体系统相耦合，因此系统的控制难度增加了，这些控制方法也就不再适用了。 本文针对液压