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

浙江大学学报（工学版）基金项目：国家高技术研究发展计划（863计划）4500米级深海作业系统，项目编号：2008AA092301通讯作者：罗高生，E-mail:[e-mail]学科代码：460•45七功能液压机械手多输入多输出非线性鲁棒控制方法研究罗高生顾临怡（浙江大学流体动力与机电系统国家重点实验室，浙江省杭州310027）摘要：针对液压驱动的七功能主从液压机械手具有强非线性、未知外界干扰以及机械手多刚体系统与液压驱动系统强耦合的多输入多输出控制系统特性，提出了利用backstepping控制器设计方法和基于滑模控制的多输入多输出鲁棒控制器方法，使用李雅普诺夫稳定性定理证明闭环系统具有渐近稳定的控制性能。利用4500米深海主从液压机械手作为仿真模型和实验对象进行仿真和实验研究表明，所提出的控制方法具有很好的跟踪性能和鲁棒性。关键词：七功能液压机械手；多输入多输出鲁棒控制；Backstepping；李雅普诺夫稳定性中图分类号：文献标识码：ResearchonNonlinearRobustAdaptiveControlofDouble-screw-pairDrivenelbowof7-funhydraulicmanipulatorLUOGao-shengGULin-yi（TheStateKeyLabofFluidPowerTransmissionandControl,ZhejiangUniversity,Hangzhou310027,China）Abstract：forcontrolcharactersofdouble-screw-pairdrivenelbowof7-funhydraulicmanipulatorwithstrongnonlinearityofhydraulicsystem,parameteruncertaintiesbytemperatureandpressurechangeofouterenvironmentandunknownouterdisturbance,afullstatefeedbackrobustadaptivecontrolmethodwaspresented,withthecombinationofbacksteppingcontrollerdesignmethodandrobustadaptivemethod,andwiththeadvantageofLyapunovstabilitytheorytoprovetheasymptoticstabilityofthecontrolsystemwithuncertaintydisturbance.Simulationandexperimentsshowsthatthepresentedfullstatefeedbackrobustadaptivecontrollerhassatisfiedcontrolcharacterandrobustness.Keywords：elbowof7-funhydraulicmanipulator;fullstatefeedbackrobustadaptivecontrol;backstepping;Lyapunovstability功能、六自由度液压机械手是一个高度耦合的多输入多输出非线性系统，各关节的运动力相互作用、相互耦合；机械手系统中的柯氏力和离心力与各关节的速度成平方关系，具有很强的非线性；六自由度机械手从手的多刚体系统再加上各关节的液压驱动系统，机械从手系系统与液压系统相互强耦合；另外，机械手的多刚体模型是非常的复杂，各关节的惯性张量、关节所受的摩擦力等均无法精确得到，因此很难对液压驱动的机械手的多刚体系统进行精确建模。未加入执行器动态的机械手机械手控制系统已经有相当的研究了，如基于PD的控制方法[103~105]，计算力矩的控制方法[106]，基于无源的控制方法[107][108][109],自适应控制方法[110]和鲁棒控制的方法[111][112]。但是如果加入执行器的动态，那么系统的阶数由原来的二阶系统变成了四阶系统，而且执行器的动态和机械手多刚体系统相耦合，因此系统的控制难度增加了，这些控制方法也就不再适用了。本文针对液压机械手的建模不精确性和具有外界未知的扰动的系统特点提出全状态反馈多输入输出非线性鲁棒控制方法以解决深海七功能液压机械手从手的轨迹跟踪鲁棒控制问题。所提出的基于滑模控制的方法可以解决机械手从手建模的不精确和存在外界月未知干扰的问题，利用backstepping[]解决液压驱动系统和机械手系统的耦合控制问题。本文主要分为三个部分，第一部提出七功能液压机械手模型及其模型特点；第二部分讨论了七功能液压机械手的多输入多输出鲁棒控制方法；第三部分和第四部分分别以4500米深海主从液压机械手作为仿真模型和实验对象进行仿真和实验研究以验证所提出控制方法的跟踪性能和鲁棒性。1七功能液压机械手从手系统建模按照拉格朗日能量法建立的七功能机械手多刚体系统的动态方程[]如下：GqKqKdtd)((1)即：GqqqCqMqqVqM),(),((2)其中：qqqBqqDqqV)()(),(2(3)其中K为机械手多刚体系统的总动能，16xRq为机械手的广义关节角度坐标变量；66)(XRqM为质量矩阵；66)(XRqD为离心力系数矩阵；156)(xRqB为柯氏力系数矩阵；162XRq广义关节角速度平方项；115XRqq为广义关节角速度交叉乘积项。液压机械手多刚体系统控制模型具有以下特性[121]：性质6.1惯性矩阵正定对称，即TqMqM)()(，因此其逆1)(qM存在；性质6.2mM，MM，使得MmMqMM)(；性质6.3qqqC),(中的元素为qqNqiT)(，)(qNi对称有界的矩阵。即)(qNi；性质6.41nxR，使得0),(2)(qqCqMT；性质6.5),(qqC具有右侧线性交换的特性，即xyqCyxqC),(),(，1,nxRyx，q液压机械手的关节空间；性质6.60MC，xCxqCM),(，1,nxRxq；性质6.70MT，使得MTqG)(，1nxRq；性质6.80Mq，使得Mqq；液压系统对液压机械手多刚体系统的驱动力矩为：))((2211PAPAqd(6-4)其中，1P，162xRP，为分别对应于机械手各关节驱动油缸或者马达两腔的油液压力；)(11iAdiagA，)(22iAdiagA，6..1i为机械手各驱动油缸或者马达两端的有效作用面积,66)()(xiRddiagqd是机械手各关节执行器对机械手相应关节的驱动力臂矩阵，力臂矩阵具有如下性质：性质6.90Md，0md使得Mmdqdd)(，q机械手的关节空间；液压缸的力学模型假设不考虑液压缸的内漏和外漏，机械手各关节执行器压力腔和回油腔的动态方程[82]分别为为：111111)(QqqxAQxAPxVe(6-5)222222)(QqqxAQxAPxVe(6-6)其中，16xRx，为油缸活塞位移或者马达的角位移，且油缸活塞的位移与关节角度关系为：16)()(xiiRqxqx，6..1i，且66xiiRqxdiagqx；)(1xV，662)(xRxV为电液比例阀到液压缸或马达两容腔的有效容积，分别为ihxdiagAVxV111)(ihxdiagAVxV222)(其中6611xihhRVdiagV，6..1i6622xihhRVdiagV，6..1i，它们是液压机械手各执行器的压力腔和回油腔的的初始容积；1Q，月162xRQ为流入和流出油缸腔体的流量，)(1xV和)(2xV具有以下性质：性质6.100MV，0mV，使得MjmVxVV)(，2..1j，x机械手各关节操作空间范围内各执行器的位移。说明6.1深海液压机械手从手驱动中肘关节和手腕旋转关节是由摆动油缸和摆线液压马达驱动的，可通过修正相应的系数，以使得他们的驱动方程与油缸的驱动方程一致。比例阀的模型电液比例阀在不考虑比例阀的死区时其模型[82]为vvqxxPgKQ))sgn(,(1111(6-7)vvqxxPgKQ))sgn(,(2222(6-8)其中，16xvRx为阀芯的位移；1qK，662xqRK，iqqKdiagK11，iqqKdiagK22，))sgn(,(11vxPg，6622))sgn(,(xvRxPg，))sgn(,())sgn(,(1111viiivxPgdiagxPg，))sgn(,())sgn(,(2222viiivxPgdiagxPg，2..1i。6..100))sgn(,(1111ixPPxPPxPgviriviisviii(6-9)6..100))sgn(,(2222ixPPxPPxPgviisviriviii(6-10)其中，sP为液压系统的供油压力；rP为液压系统的回油压力。阀芯位移与输入电压之间的关系为：uKxuv(6-11)其中66xuiuRKdiagK，uK为正定对称的对角矩阵，16xRu的控制电压输入矢量。2深海液压机械手从手多输入多输出全状态反馈鲁棒控制方法研究具有外界干扰的深海七功能液压机械手总的系统动态方程为：GPAPAqdqGqqqCqqM))(()(),()(2211(6-12a)111111)(QqqxAQxAPxVe(6-12b)222222)(QqqxAQxAPxVe(6-12c)假设6.10M，使得M。为外界干扰和海水对深海液压机械手运动阻尼产生的干扰，由此可知假设6.1是合理的假设。由方程(6-12)可知由于液压系统的存在，使得系统的阶数由原来机械手刚体系统的2阶扩大为4阶系统，液压系统与机械系统相互耦合，系统具有很强的非线性。传统的线性系统设计方法基本上不可能满足状态变量q，q，1P，2P大范围变化的要求，通过坐标变化的反馈线性化的方法也满足不了系统的要求。本节以Backstepping作为设计方法，通过适当定义几个Step之间的虚拟控制量进行控制器的反演设计。同时，考虑到机械手从手系统受到的外界干扰和模型建模不精确问题，采用滑模控制的方法，将模型的不精确和外界干扰抑制，并采用参考模型输入的方式，通过设置参考模型状态的初始值，使闭环控制系统跳过滑模过渡阶段，并使系统的跟踪速度更快收敛。Step1以机械手从手系统方程(6-12a)作为控制目标，设计控制器使得状态q渐进收敛于dq。定义为虚拟控制，并定义如下虚拟控制量：)~)(()())((~2211LLdLdPPqdPqdPAPAqd(6-13a)其中，d为期望的机械手从手控制力矩，~为期望力矩与实际控制力矩的误差。LLdLPPPAPAP~2211(6-13b)LP为等效的控制压差，LdP为期望的等效控制压差，LP~为期望等效控制压差与等效控制压差的误差。并且，使以下控制量的等式成立：LddPqd)((6-13c)即，dLdqdP)(1(6-13d)月则有：~)(~1qdPL(6-13e)由性质6.9可知，)(1qd是存在的，因此由d和~可以得到LdP和LP~。定义如下变量：跟踪位置误差，dqqq~(6-14a)相对参考速度误差，rqqqqs~~(6-14b)其中，rq为相对参考速度：qqqdr~(6-14c)其中q~，rq，16xRs分别为位置跟踪误差、参考速度、参考速度误差，idiag，6..1i，是正定的对角矩阵，