一种带连杆的六自由度液压运动平台位姿控制方法技术

本发明专利技术公开了一种带连杆的六自由度液压运动平台的控制方法，通过进行局部坐标变换，利用水平液压缸的位移获取连杆下虎克铰铰点中心坐标的表达式，通过求解方程组，由液压缸位移信号求得上平台的位姿信号，实现了带连杆六自由度运动平台的位姿正解运算，提高了由六个液压缸位移信号到运动平台的六自由度位姿信号的转换精度。结合Jacobian矩阵，给出带连杆的六自由度液压运动平台的位姿控制方法，明显提高了带连杆的六自由度液压运动平台的控制精度。本发明专利技术在内存为1G的Advantech工控机IPC‑610上测试，运行周期小于0.5ms，能够满足运动控制系统实时性要求，所以，本发明专利技术易于采用计算机数字控制实现。

Position control method for hydraulic platform with six degrees of freedom with connecting rod

The invention discloses a control method of connecting rod with six DOF hydraulic motion platform, through local coordinate transformation, to obtain Hooke hinge hinge point coordinates of the center of the connecting rod by using the displacement expression level of hydraulic cylinder, by solving the equations for position signal on the platform by the hydraulic cylinder displacement signal, realize the pose of a connecting rod with six degrees of freedom motion platform is improved by computing solution, converting the six DOF position signals of the six hydraulic cylinder displacement signal to the precision of the motion platform. Combined with Jacobian matrix, the position and orientation control method of hydraulic platform with six degrees of freedom with linkage is presented. The control accuracy of hydraulic platform with six degrees of freedom is improved obviously. The present invention in memory of 1G Advantech IPC 610 IPC test, the operation cycle is less than 0.5ms, can meet the requirements of real-time motion control system, therefore, the invention is easy to realize by computer digital control.

【技术实现步骤摘要】
一种带连杆的六自由度液压运动平台位姿控制方法
本专利技术涉及一种机械领域的机器人运动学控制方法。具体的说是一种带连杆的六自由度液压运动平台的位姿控制方法。
技术介绍
现有的多数六自由度液压运动平台，都是液压缸通过铰链和上、下两个平台直接相连。下平台和地面固定，通过液压缸的伸缩运动来驱动上平台的运动，从而模拟六个自由度的运动。可广泛的应用在航天、汽车、建筑等领域。随着科技的进步，各个领域对运动平台控制精度的要求越来越高。传统的六自由度液压运动平台，在较高的频率下，液压缸会产生较大的惯性力，不利于对运动平台的精确控制。带连杆的六自由度液压运动平台可有效解决液压缸缸体在高频振动时产生的横向振动，提高了运动平台的可靠性。采用轻量连杆，不但有效减少了驱动力用于克服液压缸本身重量所做的功，而且有效减少了克服铰接摩擦力所做的功。但目前通用六自由度液压运动平台的控制方法不适用于带连杆的六自由度液压运动平台。同时采用位姿正解算法与Jacobian矩阵，即可实现带连杆的六自由度液压运动平台的运动控制。位姿运动学正解算法主要用于由六个液压缸的位移信号求取上平台的位姿信号。现有的位姿运动学正解算法没有涉及带连杆的运动平台的。对于带连杆的六自由度液压运动平台，水平液压缸通过连杆与上平台连接，连杆的上、下虎克铰随上平台一起运动。而现有的位姿正解方法中，均假定所有液压缸的下铰点是静止不动的。若将现有的位姿正解方法应用于带连杆的六自由度液压运动平台，将极大降低控制精度，无法实现六自由度指令信号的准确再现。本专利技术涉及的参考文献如下：[1]PLUMMERA,Motioncontrolforoverconstrainedparallelservohydraulicmechanisms[C].The10thScandinavianInternationalConferenceonFluidPower,SICFP’07,Tampere,Finland,May2007。[2]PLUMMERA,Ageneralco-ordinatetransformationframeworkformulti-axismotioncontrolwithapplicationsinthetestingindustry[J].ControlEngineeringPractice,2010,18(6)：598-607。[3]SPILLMANNJ,TESCHNERM,CoRdE:Cosseratrodelementsforthedynamicsimulationofone-dimensionalelasticobjects[C].AcmSiggraph/eurographicsSymposiumonComputerAnimation,2007,6(4)：63-72。
技术实现思路
为解决现有技术存在的上述问题，本专利技术要设计一种带连杆的六自由度液压运动平台位姿控制方法，将位姿正解运算与比例积分控制器及Jacobian矩阵相结合，实现带连杆六自由度液压运动平台的高精度控制。为了实现上述目的，本专利技术的技术方案如下：一种带连杆的六自由度液压运动平台的控制方法，所述的六自由度液压运动平台包括：下平台、上平台、三个水平向液压缸、三个垂直向液压缸和三个水平向连杆；所述的三个水平向液压缸分别为1号液压缸、2号液压缸和3号液压缸；所述的三个垂直向液压缸分别为4号液压缸、5号液压缸和6号液压缸；所述的三个水平向连杆分别为1号连杆、2号连杆和3号连杆；所述的1号液压缸、2号液压缸和3号液压缸分别通过1号液压缸支座、2号液压缸支座和3号液压缸支座固定在下平台上；所述的1号连杆、2号连杆和3号连杆的末端通过各自的下虎克铰分别与1号液压缸、2号液压缸和3号液压缸连接，1号连杆、2号连杆和3号连杆的首端通过各自的上虎克铰与上平台连接；所述的4号液压缸、5号液压缸和6号液压缸的下端分别通过各自的下虎克铰与下平台连接，4号液压缸、5号液压缸和6号液压缸的上端分别通过各自的上虎克铰与上平台连接；具体的控制方法，包括以下步骤：A、设定上平台的六自由度位姿指令信号；B、利用位姿指令信号减去位姿正解计算模块的输出信号，将二者之差作为比例积分控制器模块的输入信号；C、将比例积分控制器模块的输出信号作为Jacobian矩阵的输入信号；所述的Jacobian矩阵为：式中，inv(Hh)表示对矩阵Hh进行求逆运算，R为4号液压缸、5号液压缸和6号液压缸各自的下虎克铰铰点中心所在分布圆的半径，D1为1号连杆上虎克铰铰点中心A2到2号连杆上虎克铰铰点中心A3的距离。设Jacobian矩阵的输入信号为X，则输出信号Y为Y＝Jacobian·X；D、将Jacobian矩阵的输出信号作为六个伺服阀的驱动信号，输入到伺服阀中，由伺服阀控制液压缸运动，由液压缸驱动上平台实现六自由度运动；E、采集六个液压缸的位移信号，作为位姿正解计算模块的输入信号。位姿正解模块的输出信号为上平台的位姿信号。位姿正解模块通过位姿正解计算，由六个液压缸的位移求取上平台的位姿信号；带连杆的六自由度液压运动平台的位姿正解计算，通过迭代计算的方法求取上平台位姿，每次迭代中需要求解线性方程组以获取上平台位姿增量，当精度满足要求时，迭代过程结束并输出上平台位姿。因此，正解计算中，首先给出线性方程组的具体实现形式，然后求解上平台位姿增量，最后求得上平台位姿。所述的正解计算包括以下步骤：E1、设定坐标矩阵A、B：取1号连杆、2号连杆、3号连杆、4号液压缸、5号液压缸、6号液压缸的上虎克铰铰点中心的坐标矩阵A和下虎克铰铰点中心的坐标矩阵B分别为式中，H1为1号连杆上虎克铰铰点中心A1到平台中心O的水平距离；H2为平台中心O到2号连杆上虎克铰铰点中心A2与3号连杆上虎克铰铰点中心A3的连线的水平距离；Hv为4号液压缸、5号液压缸和6号液压缸各自的上虎克铰铰点中心A4、A5和A6组成的平面到平台中心O的垂直距离；l1为1号连杆下虎克铰铰点中心B1到上虎克铰铰点中心A1的初始距离；l2为2号连杆下虎克铰铰点中心B2到上虎克铰铰点中心A2的初始距离；l3为3号连杆下虎克铰铰点中心B3到上虎克铰铰点中心A3的初始距离；Dv为4号液压缸、5号液压缸和6号液压缸各自的下虎克铰铰点中心B4、B5和B6组成的平面到平台中心O的垂直距离；ΔL1为1号液压缸的位移；ΔL2为2号液压缸的位移；ΔL3为3号液压缸的位移；E2、赋予Q0初始值设上平台六个自由度位姿信号为：Q＝[q1q2q3q4q5q6]T式中,上标T表示转置运算，q1-横摇角；q2-纵摇角；q3-偏航角；q4-沿Ox平移量；q5-沿Oy平移量；q6-沿Oz平移量。设初始值为：Q0＝[q10q20q30q40q50q60]T,Q0为6行1列的向量，q10＝0，q20＝0，q30＝0，q40＝0，q50＝0，q60＝0；E3、计算矩阵T矩阵T为4行4列矩阵，式中，c表示求余弦符号cos，例如，cq2表示cos(q2)，其余类同；s表示求正弦符号sin，例如，sq3表示sin(q3)，其余类同。E4、计算F：F为6行1列的向量。定义l4为4号液压缸下虎克铰铰点中心B4到上虎克铰铰点中心A4的初始距离；l5为5号液压缸下虎克铰铰点中本文档来自技高网...

【技术保护点】
一种带连杆的六自由度液压运动平台的控制方法，所述的六自由度液压运动平台包括：下平台(7)、上平台(8)、三个水平向液压缸、三个垂直向液压缸和三个水平向连杆；所述的三个水平向液压缸分别为1号液压缸(1)、2号液压缸(2)和3号液压缸(3)；所述的三个垂直向液压缸分别为4号液压缸(4)、5号液压缸(5)和6号液压缸(6)；所述的三个水平向连杆分别为1号连杆(9)、2号连杆(10)和3号连杆(11)；所述的1号液压缸(1)、2号液压缸(2)和3号液压缸(3)分别通过1号液压缸支座、2号液压缸支座和3号液压缸支座固定在下平台(7)上；所述的1号连杆(9)、2号连杆(10)和3号连杆(11)的末端通过各自的下虎克铰分别与1号液压缸(1)、2号液压缸(2)和3号液压缸(3)连接，1号连杆(9)、2号连杆(10)和3号连杆(11)的首端通过各自的上虎克铰与上平台(8)连接；所述的4号液压缸(4)、5号液压缸(5)和6号液压缸(6)的下端分别通过各自的下虎克铰与下平台(7)连接，4号液压缸(4)、5号液压缸(5)和6号液压缸(6)的上端分别通过各自的上虎克铰与上平台(8)连接；其特征在于：具体的控制方法，包括以下步骤：A、设定上平台(8)的六自由度位姿指令信号；B、利用位姿指令信号减去位姿正解计算模块的输出信号，将二者之差作为比例积分控制器模块的输入信号；C、将比例积分控制器模块的输出信号作为Jacobian矩阵的输入信号；所述的Jacobian矩阵为：...

【技术特征摘要】
1.一种带连杆的六自由度液压运动平台的控制方法，所述的六自由度液压运动平台包括：下平台(7)、上平台(8)、三个水平向液压缸、三个垂直向液压缸和三个水平向连杆；所述的三个水平向液压缸分别为1号液压缸(1)、2号液压缸(2)和3号液压缸(3)；所述的三个垂直向液压缸分别为4号液压缸(4)、5号液压缸(5)和6号液压缸(6)；所述的三个水平向连杆分别为1号连杆(9)、2号连杆(10)和3号连杆(11)；所述的1号液压缸(1)、2号液压缸(2)和3号液压缸(3)分别通过1号液压缸支座、2号液压缸支座和3号液压缸支座固定在下平台(7)上；所述的1号连杆(9)、2号连杆(10)和3号连杆(11)的末端通过各自的下虎克铰分别与1号液压缸(1)、2号液压缸(2)和3号液压缸(3)连接，1号连杆(9)、2号连杆(10)和3号连杆(11)的首端通过各自的上虎克铰与上平台(8)连接；所述的4号液压缸(4)、5号液压缸(5)和6号液压缸(6)的下端分别通过各自的下虎克铰与下平台(7)连接，4号液压缸(4)、5号液压缸(5)和6号液压缸(6)的上端分别通过各自的上虎克铰与上平台(8)连接；其特征在于：具体的控制方法，包括以下步骤：A、设定上平台(8)的六自由度位姿指令信号；B、利用位姿指令信号减去位姿正解计算模块的输出信号，将二者之差作为比例积分控制器模块的输入信号；C、将比例积分控制器模块的输出信号作为Jacobian矩阵的输入信号；所述的Jacobian矩阵为：式中，inv(Hh)表示对矩阵Hh进行求逆运算，R为4号液压缸(4)、5号液压缸(5)和6号液压缸(6)各自的下虎克铰铰点中心所在分布圆的半径，D1为1号连杆(9)上虎克铰铰点中心A2到2号连杆(10)上虎克铰铰点中心A3的距离；设Jacobian矩阵的输入信号为X，则输出信号Y为Y＝Jacobian·X；D、将Jacobian矩阵的输出信号作为六个伺服阀的驱动信号，输入到伺服阀中，由伺服阀控制液压缸运动，由液压缸驱动上平台(8)实现六自由度运动；E、采集六个液压缸的位移信号，作为位姿正解计算模块的输入信号；位姿正解模块的输出信号为上平台(8)的位姿信号；位姿正解模块通过位姿正解计算，由六个液压缸的位移求取上平台(8)的位姿信号；带连杆的六自由度液压运动平台的位姿正解计算，通过迭代计算的方法求取上平台(8)位姿，每次迭代中需要求解线性方程组以获取上平台(8)位姿增量，当精度满足要求时，迭代过程结束并输出上平台(8)位姿；因此，正解计算中，首先给出线性方程组的具体实现形式，然后求解上平台(8)位姿增量，最后求得上平台(8)位姿；所述的正解计算包括以下步骤：E1、设定坐标矩阵A、B：取1号连杆(9)、2号连杆(10)、3号连杆(11)、4号液压缸(4)、5号液压缸(5)、6号液压缸(6)的上虎克铰铰点中心的坐标矩阵A和下虎克铰铰点中心的坐标矩阵B分别为式中，H1为1号连杆(9)上虎克铰铰点中心A1到平台中心O的水...

【专利技术属性】
技术研发人员：关广丰，沈如涛，徐显桩，熊伟，王海涛，马文琦，孙长乐，度红望，
申请(专利权)人：大连海事大学，
类型：发明
国别省市：辽宁,21