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

1、学科代码：46045七功能液压机械手多输入多输出非线性鲁棒控制方法研究罗高生 顾临怡 （浙江大学流体动力与机电系统国家重点实验室，浙江省 杭州 310027）摘 要：针对液压驱动的七功能主从液压机械手具有强非线性、未知外界干扰以及机械手多刚体系统与液压驱动系统强耦合的多输入多输出控制系统特性，提出了利用backstepping控制器设计方法和基于滑模控制的多输入多输出鲁棒控制器方法，使用李雅普诺夫稳定性定理证明闭环系统具有渐近稳定的控制性能。利用4500米深海主从液压机械手作为仿真模型和实验对象进行仿真和实验研究表明，所提出的控制方法具有很好的跟踪性能和鲁棒性。关键词：七功能液压机械手；多输入

2、多输出鲁棒控制；Backstepping；李雅普诺夫稳定性中图分类号： 文献标识码：Research on Nonlinear Robust Adaptive Control of Double-screw-pair Driven elbow of 7-fun hydraulic manipulatorLUO Gao-sheng GU Lin-yi （The State Key Lab of Fluid Power Transmission and Control, Zhejiang University, Hangzhou 310027, China） Abstract：for contro

3、l 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 presente

4、d, 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 feedba

5、ck 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功能、六自由度液压机械手是一个高度耦合的多输入多输出非线性系统，各关节的运动力相互作用、相互耦合；机械手系统中的柯氏力和离心力与各关节的速度成平方关系，具有很强的非线性；六自由度机械手从手的多刚体系

6、统再加上各关节的液压驱动系统，机械从手系系统与液压系统相互强耦合；另外，机械手的多刚体模型是非常的复杂，各关节的惯性张量、关节所受的摩擦力等均无法精确得到，因此很难对液压驱动的机械手的多刚体系统进行精确建模。未加入执行器动态的机械手机械手控制系统已经有相当的研究了，如基于PD的控制方法103105，计算力矩的控制方法106，基于无源的控制方法107108109,自适应控制方法110和鲁棒控制的方法111112。但是如果加入执行器的动态，那么系统的阶数由原来的二阶系统变成了四阶系统，而且执行器的动态和机械手多刚体系统相耦合，因此系统的控制难度增加了，这些控制方法也就不再适用了。本文针对液压机械手

7、的建模不精确性和具有外界未知的扰动的系统特点提出全状态反馈多输入输出非线性鲁棒控制方法以解决深海七功能液压机械手从手的轨迹跟踪鲁棒控制问题。所提出的基于滑模控制的方法可以解决机械手从手建模的不精确和存在外界未知干扰的问题，利用backstepping解决液压驱动系统和机械手系统的耦合控制问题。本文主要分为三个部分，第一部提出七功能液压机械手模型及其模型特点；第二部分讨论了七功能液压机械手的多输入多输出鲁棒控制方法；第三部分和第四部分分别以4500米深海主从液压机械手作为仿真模型和实验对象进行仿真和实验研究以验证所提出控制方法的跟踪性能和鲁棒性。1 七功能液压机械手从手系统建模按照拉格朗日能量法

8、建立的七功能机械手多刚体系统的动态方程如下：(1)即：(2)其中：(3)其中为机械手多刚体系统的总动能，为机械手的广义关节角度坐标变量；为质量矩阵；为离心力系数矩阵；为柯氏力系数矩阵；广义关节角速度平方项；为广义关节角速度交叉乘积项。液压机械手多刚体系统控制模型具有以下特性121：性质6.1 惯性矩阵正定对称，即，因此其逆存在；性质6.2 ，使得；性质6.3 中的元素为，对称有界的矩阵。即；性质6.4 ，使得；性质6.5 具有右侧线性交换的特性，即，液压机械手的关节空间；性质6.6 ， ；性质6.7 ，使得， ；性质6.8 ，使得；液压系统对液压机械手多刚体系统的驱动力矩为：(6-4)其中，为

9、分别对应于机械手各关节驱动油缸或者马达两腔的油液压力； ，为机械手各驱动油缸或者马达两端的有效作用面积, 是机械手各关节执行器对机械手相应关节的驱动力臂矩阵，力臂矩阵具有如下性质：性质6.9 ，使得，机械手的关节空间；液压缸的力学模型假设不考虑液压缸的内漏和外漏，机械手各关节执行器压力腔和回油腔的动态方程82分别为为：(6-5)(6-6)其中，为油缸活塞位移或者马达的角位移，且油缸活塞的位移与关节角度关系为：，且；，为电液比例阀到液压缸或马达两容腔的有效容积，分别为其中，它们是液压机械手各执行器的压力腔和回油腔的的初始容积；，为流入和流出油缸腔体的流量，和具有以下性质：性质6.10 ，使得，机

10、械手各关节操作空间范围内各执行器的位移。说明 6.1 深海液压机械手从手驱动中肘关节和手腕旋转关节是由摆动油缸和摆线液压马达驱动的，可通过修正相应的系数，以使得他们的驱动方程与油缸的驱动方程一致。比例阀的模型电液比例阀在不考虑比例阀的死区时其模型82为(6-7)(6-8)其中，为阀芯的位移；，。 (6-9)(6-10)其中，为液压系统的供油压力；为液压系统的回油压力。阀芯位移与输入电压之间的关系为：(6-11)其中， 为正定对称的对角矩阵，的控制电压输入矢量。2 深海液压机械手从手多输入多输出全状态反馈鲁棒控制方法研究具有外界干扰的深海七功能液压机械手总的系统动态方程为：(6-12a)(6-1

11、2b)(6-12c)假设6.1 ，使得。为外界干扰和海水对深海液压机械手运动阻尼产生的干扰，由此可知假设6.1是合理的假设。由方程(6-12)可知由于液压系统的存在，使得系统的阶数由原来机械手刚体系统的2阶扩大为4阶系统，液压系统与机械系统相互耦合，系统具有很强的非线性。传统的线性系统设计方法基本上不可能满足状态变量，大范围变化的要求，通过坐标变化的反馈线性化的方法也满足不了系统的要求。本节以Backstepping作为设计方法，通过适当定义几个Step之间的虚拟控制量进行控制器的反演设计。同时，考虑到机械手从手系统受到的外界干扰和模型建模不精确问题，采用滑模控制的方法，将模型的不精确和外界干

12、扰抑制，并采用参考模型输入的方式，通过设置参考模型状态的初始值，使闭环控制系统跳过滑模过渡阶段，并使系统的跟踪速度更快收敛。Step 1以机械手从手系统方程(6-12a)作为控制目标，设计控制器使得状态渐进收敛于。定义为虚拟控制，并定义如下虚拟控制量：(6-13a)其中，为期望的机械手从手控制力矩，为期望力矩与实际控制力矩的误差。(6-13b)为等效的控制压差，为期望的等效控制压差，为期望等效控制压差与等效控制压差的误差。并且，使以下控制量的等式成立：(6-13c)即，(6-13d)则有：(6-13e)由性质6.9可知， 是存在的，因此由和可以得到和。定义如下变量：跟踪位置误差，(6-14a)

13、相对参考速度误差，(6-14b)其中，为相对参考速度：(6-14c)其中，分别为位置跟踪误差、参考速度、参考速度误差，是正定的对角矩阵，为控制器设计变量。由方程(6-14b)可知，s包含了跟踪位置误差和跟踪速度误差变量，它是位置跟踪误差和速度跟踪误差的综合体现，如果s等于0，那么就可以选择，使得，以指定的指数收敛速度收敛到0。将系统(6-12a)方程两侧减去项，得到(6-12a)方程的变体方程：(6-15a)将方程(6-14b)带入方程(6-15a)中，得到：(6-15b)对(6-15b)系统取李雅普诺夫函数为：(6-16)对求时间导数则有：(6-17)带入系统方程(6-15b)，得到：(6-

14、18a)(6-18b)由性质6.4得到，(6-18b)方程则为：(6-19)取以下期望的控制律：(6-20)其中，是对，的估计。，为正定的对角矩阵，是控制器设计参数；。将方程(6-20)带入方程中(6-19)中得到：(6-21)其中， 由性质6.2，6.6，6.7和假设6.1可以得到：(6-22)取控制参数：(6-23)其中，是可以选择的正的列矢量。则有：，(6-24)如果时，即，有：(6-25)由LaSalle-Yoshizawa定理可知：(6-26)将方程(6-26)带入方程(6-14b)中，可以得到，系统渐近稳定。此时有：(6-27)Step 2在这一步中，为了使，即，也就是只要使，这样

15、就可以使，并且获得实际的控制输入。对两端求时间导数，得：(6-28)(6-29)说明6.2 为防止不可微分，这个可以采用代替，但此时的系统不是全局渐进稳定而仅是一个局部稳定的系统，系统仅收敛于一个六维超球域。(6-30)带入系统的压力动态方程(6-12b)，(6-12c)到方程(6-30)中，可以得到：(6-31)将方程(6-31)带入方程(6-30)中，得到：(6-32)由方程(6-7) (6-11)可知，是与实际输入直接联系的，中间没有其他动态，因此，可以定义以下控制量作为作为实际的控制输入，并通过计算得到实际的控制。(6-33)为了使得，取以下期望的控制律，即：(6-34)其中，为正定的

16、对角矩阵，是控制器设计参数。将控制律(6-34)带入系统方程（6-32）中，得到：(6-35)取系统(6-12)的李雅普诺夫函数为：(6-36)对系统的李雅普诺夫函数（6-36）取时间导数，并带入方程（6-24）、（6-35），得到：(6-37)由LaSalle-Yoshizawa定理可知，将它带入系统方程(6-14b)和(6-13d)中，可以得到，系统渐近稳定。由流量方程(6-7)，(6-8)可知，与流量具有相同的符号。因此，由方程(6-7)，(6-8) ，(6-33)，(6-34)，(6-11)可以解得：(6-38)定理6.1 由控制律方程（6-38）、（6-21）所控制的深海七功能主从液

17、压机械手控制可以实现具有未知干扰和参数不确定的机械手系统（6-12）的全局渐进稳定控制。3 深海液压机械手从手多输入多输出全状态反馈鲁棒控制器仿真研究仿真参数给定仿真中，机械手从手系统采用第六章研究所获得的4500米ROV深海主从七功能液压机械手从手的多刚体系统模型中的液压驱动系统与多刚体系统的机械连接及各关节的液压缸参数。液压驱动系统见第二章图 2.13 从手机械手液压原理图所描述的比例阀阀控缸和阀控马达系统。机械手从手多刚体系统与液压驱动系统的耦合系数如下列方程(6-39)和(6-40)所描述：(6-39)其中，矩阵中的其他单元定义如下：力矩矩阵系数矩阵定义如下：(6-40)其中，矩阵中的

18、其他单元定义如下：其中方程(6-38)和(6-39)对角线上的第四个和第六个单元分别对应机械手从手的摆动油缸驱动肘关节和摆线液压马达驱动的手腕旋转关节。液压缸系统的系数矩阵定义如下述方程(6-41)，(6-42)，(6-43)，(6-44)所描述的系统。压力腔油缸有效作用面积矩阵为：(6-41)回油腔油缸作用面积矩阵定义如下： (6-42)从比例阀到油缸压力腔的有效油液容腔矩阵为：(6-43)其中，矩阵中的其他单元定义如下：从比例阀到油缸回油腔的有效油液容腔矩阵为： (6-44)其中，矩阵中的其他单元定义如下：1、 其他仿真参数表6.1为系统方程（6-12）已知的常量，表6.2为控制器参数。表

19、6.1 深海主从七功能液压机械手控制系统从手系统参数参数值参数值700Mpa110mA/V 表6.2 深海主从七功能液压机械手控制系统从手控制器参数参数值Kdiag100，500,200，50，50，20 diag2,2,10,10,10,10diag100,2000,500,20,20,102、 深海液压机械手从手多输入多输出全状态反馈鲁棒控原理图控制原理图见附件图A.5A.8。由于控制系统较为复杂，没有将所有的控制原理图一一列上，如有需要可另行提供。3、 仿真曲线仿真中分别对不具有外界扰动图6.1图6.4和具有外界扰动图6.5图6.8的情形分别进行了仿真和对比。另外，仿真中使用了说明6.2

20、的方法代替控制器中的sgn函数，边界层厚度。图6.1 位置跟踪曲线图6.2 位置跟踪误差图6.3 控制输入电压图6.4 控制输入力矩手腕摆动关节处增加100Nm外界干扰负载时的仿真曲线：图6.5 手腕摆动关节增加100Nm外界干扰力矩时的位置跟踪曲线图6.6 手腕摆动关节增加100Nm外界干扰力矩时的跟踪误差图6.7手腕摆动关节增加100Nm外界干扰力矩时的控制输入电压图6.8 手腕摆动关节增加100Nm外界干扰力矩时的控制输入力矩由图6.1和图6.2系统位置跟踪效果较好，图6.3和图6.4可知系统的控制输入平滑，对比图6.1图6.4和图6.5图6.8可知，在受到外界扰动时，控制器具有较好的鲁棒性。全状态鲁棒自适应控制器试验及结果分析实验设备和控制器参数1、 实验装置实验装置采用节相同的实验平台。2、 系统参数和控制器参数系统采用表6.1中的系统参数，其余的系统参数为方程(6-38)(6-41)所描述，控制器参数见表6.3，表6.