CN107160404A - 一种带连杆的六自由度液压运动平台位姿控制方法 - Google Patents
一种带连杆的六自由度液压运动平台位姿控制方法 Download PDFInfo
- Publication number
- CN107160404A CN107160404A CN201710591247.9A CN201710591247A CN107160404A CN 107160404 A CN107160404 A CN 107160404A CN 201710591247 A CN201710591247 A CN 201710591247A CN 107160404 A CN107160404 A CN 107160404A
- Authority
- CN
- China
- Prior art keywords
- mtd
- msub
- mrow
- mtr
- hinge
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1653—Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种带连杆的六自由度液压运动平台的控制方法,通过进行局部坐标变换,利用水平液压缸的位移获取连杆下虎克铰铰点中心坐标的表达式,通过求解方程组,由液压缸位移信号求得上平台的位姿信号,实现了带连杆六自由度运动平台的位姿正解运算,提高了由六个液压缸位移信号到运动平台的六自由度位姿信号的转换精度。结合Jacobian矩阵,给出带连杆的六自由度液压运动平台的位姿控制方法,明显提高了带连杆的六自由度液压运动平台的控制精度。本发明在内存为1G的Advantech工控机IPC‑610上测试,运行周期小于0.5ms,能够满足运动控制系统实时性要求,所以,本发明易于采用计算机数字控制实现。
Description
技术领域
本发明涉及一种机械领域的机器人运动学控制方法。具体的说是一种带连杆的六自由度液压运动平台的位姿控制方法。
背景技术
现有的多数六自由度液压运动平台,都是液压缸通过铰链和上、下两个平台直接相连。下平台和地面固定,通过液压缸的伸缩运动来驱动上平台的运动,从而模拟六个自由度的运动。可广泛的应用在航天、汽车、建筑等领域。随着科技的进步,各个领域对运动平台控制精度的要求越来越高。传统的六自由度液压运动平台,在较高的频率下,液压缸会产生较大的惯性力,不利于对运动平台的精确控制。
带连杆的六自由度液压运动平台可有效解决液压缸缸体在高频振动时产生的横向振动,提高了运动平台的可靠性。采用轻量连杆,不但有效减少了驱动力用于克服液压缸本身重量所做的功,而且有效减少了克服铰接摩擦力所做的功。但目前通用六自由度液压运动平台的控制方法不适用于带连杆的六自由度液压运动平台。
同时采用位姿正解算法与Jacobian矩阵,即可实现带连杆的六自由度液压运动平台的运动控制。位姿运动学正解算法主要用于由六个液压缸的位移信号求取上平台的位姿信号。现有的位姿运动学正解算法没有涉及带连杆的运动平台的。
对于带连杆的六自由度液压运动平台,水平液压缸通过连杆与上平台连接,连杆的上、下虎克铰随上平台一起运动。而现有的位姿正解方法中,均假定所有液压缸的下铰点是静止不动的。若将现有的位姿正解方法应用于带连杆的六自由度液压运动平台,将极大降低控制精度,无法实现六自由度指令信号的准确再现。
本发明涉及的参考文献如下:
[1]PLUMMERA,Motion control for overconstrained parallelservohydraulic mechanisms[C].The 10th Scandinavian International Conferenceon Fluid Power,SICFP’07,Tampere,Finland,May 2007。
[2]PLUMMER A,A general co-ordinate transformation framework formulti-axis motion control with applications in the testing industry[J].Control Engineering Practice,2010,18(6):598-607。
[3]SPILLMANN J,TESCHNER M,CoRdE:Cosserat rod elements for the dynamicsimulation of one-dimensional elastic objects[C].Acm Siggraph/eurographicsSymposium on ComputerAnimation,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=[q1 q2 q3 q4 q5 q6]T
式中,上标T表示转置运算,q1-横摇角;q2-纵摇角;q3-偏航角;q4-沿Ox平移量;q5-沿Oy平移量;q6-沿Oz平移量。设初始值为:
Q0=[q10 q20 q30 q40 q50 q60]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号液压缸下虎克铰铰点中心B5到上虎克铰铰点中心A5的初始距离;l6为6号液压缸下虎克铰铰点中心B6到上虎克铰铰点中心A6的初始距离;ΔL4为4号液压缸的位移;ΔL5为5号液压缸的位移;ΔL6为6号液压缸的位移。
定义符号“.*”为两个矩阵的元素相乘,例如:
则
定义符号“CSum(DD)”为矩阵DD的列向量相加,例如:
则CSum(DD)=[a+d+g b+e+h c+f+i]
则F为:
式中,上标“T”表示转置运算。
E5、计算矩阵J:
J为6行6列矩阵。
首先计算下式:
式中,Mi为6行1列的向量,表示求矩阵T对qi的偏导数;
然后得到矩阵J=[M1 M2 M3 M4 M5 M6]。
E6、求解Δqi:
Δqi为6行1列的向量。基于步骤E4求得的F及步骤E5求得的J组成方程组:J·Δqi=-F。利用QR分解方法,求取方程组的解Δqi。
E7、计算上平台位姿Qi:
Qi=Q0+Δqi
E8、检验解算精度是否满足要求:
判断Δqi的2范数是否小于求解精度ε,若小于ε,则转至步骤E10,否则,转至步骤E9。
E9、Q0重新赋值:
令Q0=Qi,转至步骤E3;
E10、上平台位姿输出
将Qi作为上平台位姿,由正解计算模块输出。
进一步地,所述的求解精度ε在[1×10-10,1×10-6]区间内取值。
与现有技术相比,本发明具有以下有益效果:
1、本发明通过进行局部坐标变换,利用水平液压缸的位移获取连杆下虎克铰铰点中心坐标的表达式,通过求解方程组,由液压缸位移信号求得上平台的位姿信号,实现了带连杆六自由度运动平台的位姿正解运算,提高了由六个液压缸位移信号到运动平台的六自由度位姿信号的转换精度。结合Jacobian矩阵,给出带连杆的六自由度液压运动平台的位姿控制方法,明显提高了带连杆的六自由度液压运动平台的控制精度。
2、本发明可以通过软件编程实现。在CPU为Intel PD 2.6G、内存为1G的Advantech工控机IPC-610上测试,算法的运行周期小于0.5ms,能够满足运动控制系统实时性要求,所以本发明易于采用计算机数字控制实现。
附图说明
图1是带连杆的六自由度液压运动平台的结构示意图。
图2是图1的侧视图。
图3是图1的俯视图。
图4是本发明的流程图。
图5是位姿正解算法的流程图。
图中:1、1号液压缸,2、2号液压缸,3、3号液压缸,4、4号液压缸,5、5号液压缸,6、6号液压缸,7、下平台,8、上平台,9、1号连杆,10、2号连杆,11、3号连杆。
具体实施方式
下面结合附图对本发明进行进一步地描述。如图1-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矩阵为:
式中,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的水平距离;H2为平台中心O到2号连杆10上虎克铰铰点中心A2与3号连杆11上虎克铰铰点中心A3的连线的水平距离;Hv为4号液压缸4、5号液压缸5和6号液压缸6各自的上虎克铰铰点中心A4、A5和A6组成的平面到平台中心O的垂直距离;l1为1号连杆9下虎克铰铰点中心B1到上虎克铰铰点中心A1的初始距离;l2为2号连杆10下虎克铰铰点中心B2到上虎克铰铰点中心A2的初始距离;l3为3号连杆11下虎克铰铰点中心B3到上虎克铰铰点中心A3的初始距离;Dv为4号液压缸4、5号液压缸5和6号液压缸6各自的下虎克铰铰点中心B4、B5和B6组成的平面到平台中心O的垂直距离;ΔL1为1号液压缸1的位移;ΔL2为2号液压缸2的位移;ΔL3为3号液压缸3的位移;
E2、赋予Q0初始值
设上平台8六个自由度位姿信号为:
Q=[q1 q2 q3 q4 q5 q6]T
式中,上标T表示转置运算,q1-横摇角;q2-纵摇角;q3-偏航角;q4-沿Ox平移量;q5-沿Oy平移量;q6-沿Oz平移量。设初始值为:
Q0=[q10 q2 0q30 q40 q50 q60]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号液压缸4下虎克铰铰点中心B4到上虎克铰铰点中心A4的初始距离;l5为5号液压缸5下虎克铰铰点中心B5到上虎克铰铰点中心A5的初始距离;l6为6号液压缸6下虎克铰铰点中心B6到上虎克铰铰点中心A6的初始距离;ΔL4为4号液压缸4的位移;ΔL5为5号液压缸5的位移;ΔL6为6号液压缸6的位移。
定义符号“.*”为两个矩阵的元素相乘,例如:
则
定义符号“CSum(DD)”为矩阵DD的列向量相加,例如:
则CSum(DD)=[a+d+g b+e+h c+f+i]
则F为:
式中,上标“T”表示转置运算。
E5、计算矩阵J:
J为6行6列矩阵。
首先计算下式:
式中,Mi为6行1列的向量,表示求矩阵T对qi的偏导数;
然后得到矩阵J=[M1 M2 M3 M4 M5 M6]。
E6、求解Δqi:
Δqi为6行1列的向量。基于步骤E4求得的F及步骤E5求得的J组成方程组:J·Δqi=-F。利用QR分解方法,求取方程组的解Δqi。
E7、计算上平台8位姿Qi:
Qi=Q0+Δqi
E8、检验解算精度是否满足要求:
判断Δqi的2范数是否小于求解精度ε,若小于ε,则转至步骤E10,否则,转至步骤E9。
E9、Q0重新赋值:
令Q0=Qi,转至步骤E3;
E10、上平台8位姿输出
将Qi作为上平台8位姿,由正解计算模块输出。
进一步地,所述的求解精度ε在[1×10-10,1×10-6]区间内取值。
本发明的实施例如下:
取图1所示六自由度液压运动平台的结构参数为:R=3.5×=3-1米,D1=6×1=-1米,l1=7.2×7.-1米,l2和l3的值与l1相同,Dv=1.23米,H1=6.2×6.-1米,H2的值与H1相同,Hv=1.5×1.-1米。
设上平台8六自由度位姿指令信号为[0度 0度 5度 1×10-2米 0米 0米],定义液压缸伸出方向为位移正方向。当六个液压缸的位移信号分别为1.439×10-2米、-2.083×10-2米、3.126×10-2米、7.284×10-4米、4.655×10-4米和2.394×10-4米时,上平台8的实际输出位姿为[0度 0度 5度 1×10-2米 0米 0米],与位姿指令信号一致。应用现有的位姿正解算法,可求得上平台8的输出位姿信号为[-3.564×10-3度 -4.11×10-3度 5.003度 1.074×10-2米 9.121×10-4米 0米]。应用本发明提出的带连杆的位姿正解算法,可求得上平台8的输出位姿为[0度 0度 5度1×10-2米 0米 0米],与实际输出位姿一致。对比上平台8实际输出位姿与现有位姿正解算法得出的位姿信号及本发明提出的带连杆的位姿正解算法得出的位姿信号可知,现有位姿正解算法存在偏差,本发明提出的位姿正解算法能够实现由六个液压缸位移信号到上平台8六自由度位姿信号的高精度转换。应用本发明提出的带连杆的位姿控制方法,能够明显提高六自由度位姿指令的再现精度。
本发明不局限于本实施例,任何在本发明披露的技术范围内的等同构思或者改变,均列为本发明的保护范围。
Claims (2)
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矩阵为:
<mrow>
<mi>J</mi>
<mi>a</mi>
<mi>c</mi>
<mi>o</mi>
<mi>b</mi>
<mi>i</mi>
<mi>a</mi>
<mi>n</mi>
<mo>=</mo>
<mi>i</mi>
<mi>n</mi>
<mi>v</mi>
<mrow>
<mo>(</mo>
<msub>
<mi>H</mi>
<mi>h</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>,</mo>
<msub>
<mi>H</mi>
<mi>h</mi>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>R</mi>
</mrow>
</mfrac>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>R</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>3</mn>
<mi>R</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
<mtd>
<mfrac>
<mn>2</mn>
<mrow>
<mn>3</mn>
<mi>R</mi>
</mrow>
</mfrac>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>3</mn>
<mi>R</mi>
</mrow>
</mfrac>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
</mfrac>
</mrow>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
</mfrac>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
</mtd>
<mtd>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>3</mn>
</mfrac>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
式中,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分别为
<mrow>
<mi>A</mi>
<mo>=</mo>
<msub>
<mrow>
<mo>(</mo>
<msub>
<mi>a</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mn>4</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mi>R</mi>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mi>V</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mi>V</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>H</mi>
<mi>V</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
<mrow>
<mi>B</mi>
<mo>=</mo>
<msub>
<mrow>
<mo>(</mo>
<msub>
<mi>b</mi>
<mrow>
<mi>i</mi>
<mi>j</mi>
</mrow>
</msub>
<mo>)</mo>
</mrow>
<mrow>
<mn>4</mn>
<mo>&times;</mo>
<mn>6</mn>
</mrow>
</msub>
<mo>=</mo>
<mfenced open = "(" close = ")">
<mtable>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;L</mi>
<mn>1</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>D</mi>
<mn>1</mn>
</msub>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mi>R</mi>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;L</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>H</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>l</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;L</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msqrt>
<mn>3</mn>
</msqrt>
<mi>R</mi>
<mo>/</mo>
<mn>2</mn>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>D</mi>
<mi>V</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>D</mi>
<mi>V</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>D</mi>
<mi>V</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
式中,H1为1号连杆(9)上虎克铰铰点中心A1到平台中心O的水平距离;H2为平台中心O到2号连杆(10)上虎克铰铰点中心A2与3号连杆(11)上虎克铰铰点中心A3的连线的水平距离;Hv为4号液压缸(4)、5号液压缸(5)和6号液压缸(6)各自的上虎克铰铰点中心A4、A5和A6组成的平面到平台中心O的垂直距离;l1为1号连杆(9)下虎克铰铰点中心B1到上虎克铰铰点中心A1的初始距离;l2为2号连杆(10)下虎克铰铰点中心B2到上虎克铰铰点中心A2的初始距离;l3为3号连杆(11)下虎克铰铰点中心B3到上虎克铰铰点中心A3的初始距离;Dv为4号液压缸(4)、5号液压缸(5)和6号液压缸(6)各自的下虎克铰铰点中心B4、B5和B6组成的平面到平台中心O的垂直距离;ΔL1为1号液压缸(1)的位移;ΔL2为2号液压缸(2)的位移;ΔL3为3号液压缸(3)的位移;
E2、赋予Q0初始值
设上平台(8)六个自由度位姿信号为:
Q=[q1 q2 q3 q4 q5 q6]T
式中,上标T表示转置运算,q1-横摇角;q2-纵摇角;q3-偏航角;q4-沿Ox平移量;q5-沿Oy平移量;q6-沿Oz平移量;设初始值为:
Q0=[q10 q20 q30 q40 q50 q60]T,
Q0为6行1列的向量,q10=0,q20=0,q30=0,q40=0,q50=0,q60=0;
E3、计算矩阵T
<mrow>
<mi>T</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cq</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>cq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>sq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>cq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>2</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mn>4</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>cq</mi>
<mn>2</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>sq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>2</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>3</mn>
</msub>
<mo>+</mo>
<msub>
<mi>cq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>2</mn>
</msub>
<msub>
<mi>sq</mi>
<mn>3</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mn>5</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>sq</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>sq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>cq</mi>
<mn>1</mn>
</msub>
<msub>
<mi>cq</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>q</mi>
<mn>6</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
</mrow>
矩阵T为4行4列矩阵,式中,c表示求余弦符号cos,s表示求正弦符号sin;
E4、计算F:
F为6行1列的向量;定义l4为4号液压缸(4)下虎克铰铰点中心B4到上虎克铰铰点中心A4的初始距离;l5为5号液压缸(5)下虎克铰铰点中心B5到上虎克铰铰点中心A5的初始距离;l6为6号液压缸(6)下虎克铰铰点中心B6到上虎克铰铰点中心A6的初始距离;ΔL4为4号液压缸(4)的位移;ΔL5为5号液压缸(5)的位移;ΔL6为6号液压缸(6)的位移;
定义符号“.*”为两个矩阵的元素相乘,定义符号“CSum(DD)”为矩阵DD的列向量相加,则F为:
<mfenced open = "" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>F</mi>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>C</mi>
<mi>S</mi>
<mi>u</mi>
<mi>m</mi>
<mrow>
<mo>(</mo>
<mo>(</mo>
<mrow>
<mi>T</mi>
<mo>&CenterDot;</mo>
<mi>A</mi>
<mo>-</mo>
<mi>B</mi>
</mrow>
<mo>)</mo>
<mo>.</mo>
<mo>*</mo>
<mo>(</mo>
<mrow>
<mi>T</mi>
<mo>&CenterDot;</mo>
<mi>A</mi>
<mo>-</mo>
<mi>B</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msubsup>
<mi>l</mi>
<mn>1</mn>
<mn>2</mn>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>l</mi>
<mn>2</mn>
<mn>2</mn>
</msubsup>
</mtd>
<mtd>
<msubsup>
<mi>l</mi>
<mn>3</mn>
<mn>2</mn>
</msubsup>
</mtd>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>l</mi>
<mn>4</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;l</mi>
<mn>4</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mtd>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>l</mi>
<mn>5</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;l</mi>
<mn>5</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mtd>
<mtd>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>l</mi>
<mn>6</mn>
</msub>
<mo>+</mo>
<msub>
<mi>&Delta;l</mi>
<mn>6</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
式中,上标“T”表示转置运算;
E5、计算矩阵J:
J为6行6列矩阵;
首先计算下式:
<mrow>
<msub>
<mi>M</mi>
<mi>i</mi>
</msub>
<mo>=</mo>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<mi>C</mi>
<mi>S</mi>
<mi>u</mi>
<mi>m</mi>
<mrow>
<mo>(</mo>
<mo>(</mo>
<mrow>
<mi>T</mi>
<mo>&CenterDot;</mo>
<mi>A</mi>
<mo>-</mo>
<mi>B</mi>
</mrow>
<mo>)</mo>
<mo>.</mo>
<mo>*</mo>
<mo>(</mo>
<mrow>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>T</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<msub>
<mi>q</mi>
<mi>i</mi>
</msub>
</mrow>
</mfrac>
<mo>&CenterDot;</mo>
<mi>A</mi>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>,</mo>
<mi>i</mi>
<mo>=</mo>
<mn>1</mn>
<mo>,</mo>
<mn>...</mn>
<mo>,</mo>
<mn>6</mn>
</mrow>
式中,Mi为6行1列的向量,表示求矩阵T对qi的偏导数;
然后得到矩阵J=[M1 M2 M3 M4 M5 M6];
E6、求解Δqi:
Δqi为6行1列的向量;基于步骤E4求得的F及步骤E5求得的J组成方程组:J·Δqi=-F;利用QR分解方法,求取方程组的解Δqi;
E7、计算上平台(8)位姿Qi:
Qi=Q0+Δqi
E8、检验解算精度是否满足要求:
判断Δqi的2范数是否小于求解精度ε,若小于ε,则转至步骤E10,否则,转至步骤E9;
E9、Q0重新赋值:
令Q0=Qi,转至步骤E3;
E10、上平台(8)位姿输出
将Qi作为上平台(8)位姿,由正解计算模块输出。
2.根据权利要求1所述的一种带连杆的六自由度液压运动平台的控制方法,其特征在于:所述的求解精度ε在[1×10-10,1×10-6]区间内取值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710591247.9A CN107160404B (zh) | 2017-07-19 | 2017-07-19 | 一种带连杆的六自由度液压运动平台位姿控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710591247.9A CN107160404B (zh) | 2017-07-19 | 2017-07-19 | 一种带连杆的六自由度液压运动平台位姿控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107160404A true CN107160404A (zh) | 2017-09-15 |
CN107160404B CN107160404B (zh) | 2020-02-14 |
Family
ID=59816933
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710591247.9A Active CN107160404B (zh) | 2017-07-19 | 2017-07-19 | 一种带连杆的六自由度液压运动平台位姿控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107160404B (zh) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108626203A (zh) * | 2018-05-14 | 2018-10-09 | 大连海事大学 | 一种六自由度运动平台电液伺服系统的低频干扰补偿方法 |
CN108618268A (zh) * | 2018-06-12 | 2018-10-09 | 董建芬 | 一种鞋底自动打胶固定装置 |
CN109655220A (zh) * | 2019-01-17 | 2019-04-19 | 大连海事大学 | 一种六自由度双电液振动台台阵模拟系统的位姿控制方法 |
CN109708836A (zh) * | 2019-01-17 | 2019-05-03 | 大连海事大学 | 一种两自由度双电液振动台台阵模拟系统的位姿控制方法 |
CN109813514A (zh) * | 2019-03-08 | 2019-05-28 | 大连海事大学 | 一种六自由度双电液振动台台阵模拟系统的刚度控制方法 |
CN109856960A (zh) * | 2019-03-08 | 2019-06-07 | 大连海事大学 | 一种两自由度双电液振动台台阵模拟系统的刚度控制方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5901936A (en) * | 1997-08-25 | 1999-05-11 | Sandia Corporation | Six-degree-of-freedom multi-axes positioning apparatus |
US20020005069A1 (en) * | 2000-05-01 | 2002-01-17 | Satcon Technology Corporation | Six degree of freedom magnetically levitated vibration table |
CN101173876A (zh) * | 2007-11-30 | 2008-05-07 | 哈尔滨工业大学 | 基于运动学的三轴六自由度液压振动台控制方法 |
CN103323234A (zh) * | 2013-05-28 | 2013-09-25 | 清华大学 | 一种实现位姿控制和主轴加载的风机增速箱试验台 |
US20170072327A1 (en) * | 2015-09-11 | 2017-03-16 | Disney Enterprises, Inc. | Six degree of freedom (dof) motion platform without non-redundant load paths |
-
2017
- 2017-07-19 CN CN201710591247.9A patent/CN107160404B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5901936A (en) * | 1997-08-25 | 1999-05-11 | Sandia Corporation | Six-degree-of-freedom multi-axes positioning apparatus |
US20020005069A1 (en) * | 2000-05-01 | 2002-01-17 | Satcon Technology Corporation | Six degree of freedom magnetically levitated vibration table |
CN101173876A (zh) * | 2007-11-30 | 2008-05-07 | 哈尔滨工业大学 | 基于运动学的三轴六自由度液压振动台控制方法 |
CN103323234A (zh) * | 2013-05-28 | 2013-09-25 | 清华大学 | 一种实现位姿控制和主轴加载的风机增速箱试验台 |
US20170072327A1 (en) * | 2015-09-11 | 2017-03-16 | Disney Enterprises, Inc. | Six degree of freedom (dof) motion platform without non-redundant load paths |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108626203A (zh) * | 2018-05-14 | 2018-10-09 | 大连海事大学 | 一种六自由度运动平台电液伺服系统的低频干扰补偿方法 |
CN108618268A (zh) * | 2018-06-12 | 2018-10-09 | 董建芬 | 一种鞋底自动打胶固定装置 |
CN109655220A (zh) * | 2019-01-17 | 2019-04-19 | 大连海事大学 | 一种六自由度双电液振动台台阵模拟系统的位姿控制方法 |
CN109708836A (zh) * | 2019-01-17 | 2019-05-03 | 大连海事大学 | 一种两自由度双电液振动台台阵模拟系统的位姿控制方法 |
CN109708836B (zh) * | 2019-01-17 | 2020-06-09 | 大连海事大学 | 一种两自由度双电液振动台台阵模拟系统的位姿控制方法 |
CN109655220B (zh) * | 2019-01-17 | 2020-06-09 | 大连海事大学 | 一种六自由度双电液振动台台阵模拟系统的位姿控制方法 |
CN109813514A (zh) * | 2019-03-08 | 2019-05-28 | 大连海事大学 | 一种六自由度双电液振动台台阵模拟系统的刚度控制方法 |
CN109856960A (zh) * | 2019-03-08 | 2019-06-07 | 大连海事大学 | 一种两自由度双电液振动台台阵模拟系统的刚度控制方法 |
CN109856960B (zh) * | 2019-03-08 | 2020-10-02 | 大连海事大学 | 一种两自由度双电液振动台台阵模拟系统的刚度控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107160404B (zh) | 2020-02-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107160404A (zh) | 一种带连杆的六自由度液压运动平台位姿控制方法 | |
CN107270061B (zh) | 一种带连杆的六自由度液压运动平台控制方法 | |
CN103495977B (zh) | 一种6r型工业机器人负载识别方法 | |
Kang | Closed-form force sensing of a 6-axis force transducer based on the Stewart platform | |
Li et al. | Modeling, simulation, and control of a hydraulic Stewart platform | |
CN103558079B (zh) | 基于并联机构驱动力闭环的多自由度加载方法 | |
CN108582078A (zh) | 一种面向直接示教的机械臂零力控制方法 | |
CN110561425B (zh) | 绳索驱动的柔性机器人力位混合控制方法及系统 | |
CN113465861B (zh) | 一种两自由度电液振动台的干扰力补偿方法 | |
CN113465859B (zh) | 一种六自由度电液振动台的干扰力补偿方法 | |
CN107336231A (zh) | 六自由度并联平台结构参数优化方法 | |
CN108445764B (zh) | Stewart平台的主动柔顺控制策略 | |
CN110361150A (zh) | 一种六自由度电液振动台自抗扰控制方法 | |
Korayem et al. | Development of ICASBOT: a cable-suspended robot’s with Six DOF | |
Zhang et al. | Workspace analysis and optimal design of a translational cable-driven parallel robot with passive springs | |
CN112001087B (zh) | 一种旋转关节型工业机器人非线性动力学建模分析方法 | |
You et al. | Dynamic control of a 3-DOF cable-driven robot based on backstepping technique | |
CN104820728B (zh) | 一种水田激光平地机调平系统动力学建模方法 | |
CN103217924B (zh) | 面向实时控制应用的过约束重型并联机床动力学建模方法 | |
CN115292665B (zh) | 基于六自由度运动平台的一体化拆解装备建模方法 | |
CN206105842U (zh) | 摆动气缸驱动的三自由度柔性并联机构控制装置 | |
CN116657695B (zh) | 装载机工作装置的控制方法、装置及系统 | |
Zhu et al. | Optimization design and dynamic stability analysis of 3-DOF cable-driven parallel robot with an elastic telescopic rod | |
CN205538475U (zh) | 一种软材料力学性能测量装置 | |
Zhang et al. | Research on the rigid-flexible multibody dynamics of concrete placing boom |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |