六自由度运动模拟器

基于模型的阻抗控制六自由度电液斯图尔平台

摘要—本文详细描述了一个以模型为基础的阻抗控制六自由度电液斯图尔平台，刚体和电液伺服阀模型，包括所用伺服阀模型和一套完整的系统方程，也包括摩擦和泄漏液压原件。所设计的控制器是采用系统动力学和液压模型产生伺服阀电流。控制规则包括反馈和前馈两个单独的部分。根据指定的特性阻抗过滤器会修改所需的轨迹，修改后的轨迹被送入系统模型，以减少非线性液压动力的影响。提出了模拟的典型期望轨迹，并得到了拥有良好性能的控制器。

1．导言

最早的6自由度（DOF）斯图尔特高夫平台是在1954年发明的。在1965年，样机的平行机构被用做一个具有六自由度运动平台的飞行模拟器。此后，许多关于这种机构以及相关研究被发表，该机构可以是电动也可以是液动。许多研究人员已经研究了斯图尔特平台的动力学和运动学。然而驱动力却没有被考虑完全。虽然电动斯图尔平台已被广泛运用，但是很少有研究是关于包括驱动和控制的完整动力学。

阻抗控制被认为是一种积极的兼容的运动控制，主要需要行业应用并于周围环境相互作用，例如数控机床，铣床等。这种控制器同时具有安全性和灵活性，相对而言是首选。

液压科学与控制相结合，得到了新的液压系统的应用。这也是为什么液压系统会被作为一些工业和移动式应用机电驱动的首选。包括它们大批量快速生产的能力，它们的耐久性和刚度，还有他们的响应速度，液压体系不同于机电体系，在液压体系中力或例句输出与执行器的电流是不成真比的，因此，液压执行器不能作为力矩的来源模仿，但是可以作为受控阻抗，所以，要设计出了控制机器人的控制器。驱动力/力矩的虚拟设置在这里始终不可行。

控制技术被用来补偿电动液压伺服系统的非线性。研究人员已经提出了关于液压伺服系统的非线性自适应控制技术的假设、反推以及方式。一个强力的控制器是在非线性定量反馈理论的基础上设计的，已被工业液力执行机构所实现，同时考虑了系统和环境的不确定性。一个电动机械手控制的统一方式适用于任何提案。运动学约束议案，以及机机械臂及其环境之间的动态交互研究已经通过审查。制定所需的机械臂阻抗技术和对一个给定应用程序选择适当的阻抗的技术的最优化理论已经被提出。这里有两种控制机电驱动高夫斯图尔特并行平台机械阻抗的空间几何方法，第一种基于球形位置函数，第二种则是利用指数映射关联有限位移与扭转位移平衡的平台。

一个基于模型的高性能的压接头液压伺服系统前馈反馈阻抗控制器已经被提出，在这里，一个阻抗根据在自由空间或空间接触的行为来调整过滤器所需的轨迹，类似已提交的工作，其中基于位置阻抗控制器工业液压机械手已开发。此外，阻抗控制器研究已在遥控轮式液压伺服系统和重型工程中实施。

在这篇论文中，提及了一种基于模型的六自由度电液伺服斯图尔特关节对称平台阻抗控制器，用于描述刚体斯图尔特平台和液压驱动系统，对比其它方法，这里有伺服模型和摩擦模型。先进的控制方案在分析方案时，应用了刚体、驱动力学和伺服阀的输入电流矢量。控制规律包括两个信号，反馈信号和前馈信号。根据指定的行为阻抗过滤器会修改所需的轨迹。修改后的轨迹被送入系统模型，以减少非线性液压动力的影响。现金控制器的性能说明使用了典型的轨迹。拟议的方法可以扩展到串行或闭链机器人和模拟器。

2系统建模

在本节中，研究了六自由度电液伺服斯图尔特平台的动态模型，这是一个由支架和六个线性驱动器组成的闭环运动体系，该体系的原理如图1所示：

图1：(a)六自由度的斯图尔特平台示意图(b)六个舵机中的两个

A机械动力学

一个完整的伺服系统模型，包括移动质量运动方程。该系统提供了执行器的扭矩/力和由此产生的作用效果之间的关系。斯图尔特平台系统的运动方程是利用拉格朗日公式推导出来的该公式为：

M(x) x + V(x, x) + G(x) + F fr(x) =τ（1）

x = (x0, y0, z0, p, q, r)表示6×1的广义坐标向量如式（1）x0, y0, z0，表示大范围直角坐标系的中心p ,

q r表示的是平台欧拉角。M(x)表示6×6正定质量矩阵系统。6×1向量V(x, x_ )代表离心产生的力/力矩和科里奥利力，6×1向量G(x)代表由于重力而产生的力矩，F fr(x)代表6×1 因摩擦而产生的力/力矩，T代表6×1向量广义作用力的载体。方程（1）可以进一步的转变为执行机构力和应用广义力之间的关系。这是由下面的公式得出的：

τ=J T F (2)

期中J表示的是雅克比6×6矩阵系统，F表示的是一个6×1的向量代表执行机构力是有公式：

F p=(F p1+F p2….+F p6)T （3）期中F p j，j=12…6表示的是单体液力演示平台。

使用机制的逆运动学，该平台所描述的笛卡尔运动经过公式（1）变形

后可写为：

期中表示的是6×向量长度机制驱动器。M*(x)表示的是一个6×6的正定矩阵，V*(x,x)表示的是一个6×1包含离心力和科里奥利力的载体，G*(x)是一个矢量

力。表示的是一个6×1包含联合空间摩擦力的载体。M* (x) , V* (x,x_ )和G* (x)这几项是已知的分别表示为：

有许多可以用于模拟摩擦载体的方法。有一种比较广泛使用的模型摩擦法可以表示为：

其中和F表示的是向量，库仑和静摩擦载体的元素：

其中b j表示第j th个参数为粘性摩擦元素，F c0, j是j的库伦原件摩擦参数，F ext, j是j的外部因素，F s0, j是j的分离力原件

（8）

用于控制目的，六力的测定平台上被认为是未来的。这是网平台的驱动力，可以通过测量力传感器，例如[25]，或计算

其中M pl表示的是平台正定的6*6质量矩阵，V pl表示的是所产生的力/力矩。在平台上的离心力和科里奥利力，和G pl表示的是表由于重力作用的平台力/力矩该平台的电动驱动伺服系统由活塞，伺服阀，控制器，传感器和液压动力供应。下一步，对电动液压伺服系统的主要组成部分的水力模型进行了介绍。液压用品通常包括恒压活塞泵，感应电驱动电机。因此，泵建模的时候建立为一个常数压力源。此外，他们还可能包括蓄电池过滤泵的压力脉动，但也允许使用较小的评级泵提供需要时额外的流量。单杆液压伺服缸如原理图- 2。有关机械到方程液压变量由以下描述

其中Q1, Q2表示的是流经两缸室的端口，p1, p2表示的是腔压力，A1表示的是活塞侧面积，A2表示的是杆面面积，，C1, C2是汽缸室内的流体电容G p,in代表缸内部泄漏电导，￡是总执行器的长度，F p是液压的力量，F fr,p表示的是制动器的摩擦力，F ac t表示的是执行机构输出净额。在一个双杆液压缸的情况下，A1和A2两个领域都是平等的，因此，（9）是简化的。液压系统的控制是通过使用伺服阀，见图- 3（a）。这里被认为只有一个阀门的电阻效果，因为他们的自然频率比机械负荷高得多-。它也被认为阀门的几何结构是理想的，如阀门有锋利的边缘和零交叉泄漏（图2）

图二：一种液压舵机模型示意图

一个典型的电液伺服阀由四个对称和匹配伺服阀流路，通过四个非线性电阻窍，由输入电压调制，见图- 3（a）。从而，相当于是仿照惠斯登电桥的液压伺服阀，见图-3（b）。当伺服阀的

输入电流是正的，i> 0，流量通过窍1和3（路径P-A-B-T），并在阀孔2和4的流量泄漏存在。同样，当伺服阀的输入电流是负的，i <0，流量通过的路径P-A-B-T，阀孔1和3存在流量泄漏。见（图3）

图三，液压伺服阀模型示意图

模型由以下公式描述：

Q v1 =f1(i,C d,p)Jp v,in-p1 (11a)

Qv2=f2(i,C d,p)y lp v,in-p2(11b)

Q v3=g1(i,C d,p)y jp2-p v,out (11c)

Q v4=g2(i,C d,p)y lp1-p v,out (11d)

期中Q v1, Q v2, Q v3和Q v4表示的是通过窍1，2，3和4的伺服阀流量。p v,in和p v,out表示的是伺服阀压力相应的输入和输出系统，i表示的是当前电机伺服阀（控制指令），f1(i,C d,p), f2(i,C d,p), g1(i,C d,p) 和2(i,C d,p)表示的是在伺服阀电机电流的非线性函数，C d表示的是流量系数而且p表示的是流体的质量密度，在一般情况下，流量系数和雷诺数说明了阀门的功能。然而，流体的密度和雷诺依赖薄弱的湍流，因此，只有当前的依赖很显著。因此，功能f1(i,C d,p), f2(i,C d,p), g1(i,C d,p)和,g2(i,C d,p)减少到f1 (i), f2(i), g1(i)和g2(i),由于对称伺服阀，目前功能由以下公式给出：

f 1( i)=g1(i) = f2(-i) = g2(-i) （12a）

f2(i) = g2(i) = f1(-i ) = g1(-i ) （12b

我们的实验结果表明，假定当流量通过主要路径，这些功能是输入电流的线性函数，当流量通过漏流路径有一个固定的值，这是一个很好的近似值 [25]。例如，当i>0，主要流量（11）通过孔1和3，因此，其函数被写成，

f1(i)=g1(i)=K1i+K0,1(13a)

f2(i)=g2(i)=K0,1(13b) 其中K1和K0，1是正数，它们分别对应的主要和泄漏阀门的流量。K1和K0，1是两和四通阀芯MOOG G761-3004系列高性能伺服阀实验计算的常数，结果如图4所示[25]。

图4 伺服阀目前主要和泄漏流量的函数

如果在伺服阀和气缸室的泄漏流量被忽视，通过窍（11A，C）中描述的伺服阀的流量与通过汽缸内腔端口的流量相等，如（10A，B）所示，并写成，

Q v1=Q1=Al+C1p1(14a)

Q v3=Q2=Al-C2p2(14b) 此外，连续性方程以每个活塞室的产率相结合[9] ,

V t(4βe)-1ΔP L=Q L-(A1-A2)l (15) V t表示的是在两室压缩下的流体的总体积，βe表示的是流体的有效体积弹性模量，ΔP L=p1-p2表示的是活塞的压差，并且Q L是负载流量，从而给出，[9],

(16)

其中，F(i)表示的是伺服阀电流函数,即，

F(i)= f1(i),i>0 (17)

f2(i),i<0

六自由度电液伺服辅助系统的液压软管是可压缩液压管路的模具，描述软管动力方程如下：

P l,in-P l,m=PQ l,in (18a) Q l,out=(P l,m-P l,out·I-1 (18a) P l,m=(Q l,in-Q l.ou·C-1 (18b) Pl,in，Pl,out和Pl,m的分别表示的是输入，输出和中间点的软管压力，Ql,in ，Ql.out表示的是在其输入和输出时通过的软管流量，相应的软管参数R，I，C分别表示的是液压线的阻力，惯性和电容。

C.集成系统方程

六自由度Stewart平台液压和负载的动态反应可以通过集成的系统得出的方程，用系统的方法来描述，如线性图表，[22]，或键合图方法，[26]。并为此，需要提供改变动力的压力差表达式，见（9c），流动速度，见（10a，b）。在一般情况下，集成式液压和机械负载动力学用非线性方程组描述为：

x =f(x)+g(x)u (19)

y=h(x) x0=x(t0)=x(0)

其中x表示的是一个状态的列向量，x0为初始时间t0= 0时初始状态的列向量，u是输入列向量，y是输出列向量，f（x)，g(x)和h(x)是非线性函数。

这里也有线性图方法应用，全新型六自由度液压伺服系统线性图如图5 所示

图5 六自由度电液斯图尔平台模型的全线性图

应用连续性和兼容性的规律，同时拥有单独的方程，在表格（19）中得出了一个48阶非线性微分方程，公式如下：

期中Q I , 1, j A , Q I , 2, j是j th的液压压力和返回线对应p s , p T 表示电力供应和回流压力的伺服系统。分开来讲p C, 1, j A , p C, 2, j表示与j th 相对应的液压动力和返回线与线的电容I 1, j A , R 1, j A , C 1, j 表示j th液压动力线中的惯量、电阻电容I 2, j A , R 2, j A , C 2, j 表示j th液压回流管中的惯量。电阻电容，v j表示j th 的活塞运动速度，相当于j th的向量元素。[m_]j 表示对于1×6矩阵所对应的行，Δp G（i）|jΔp G3（i）|j分别代表伺服阀孔1、3的压力。是由流量的连续性而确定的，根据驱动器和伺服阀元素方程可以得到

此外，需要使用流量连续性的规律，以及液压伺服阀线性方程，期中在20（a b）中的Q v2, j (i)和Q v4, j (i )是由：

得出的。

执行器的位移x p, j和速度v p, j 代表整个系统的输出这是由两倍（20克）和一倍的（20h）分别决定的。

3．阻抗控制设计

阻抗控制基本上可以使一个物理系统效仿另外一个，假设新的特性是物理系统的内在功能，在这一节中，介绍了基于模型的阻抗为六自由度电液伺服控制设计斯图尔特平台的开发这里提出的控制设计策略包括两个控制部件，前馈和反馈。先进的控制分析是基于动态和液压系统模型的，因此，它假定了动态矩阵M* (x)和向量图（4）中已知向量V* (x,x_ )、G* (x)。

在机电领域，执行机构的洛伦兹力与执行器的电流成正比，这就简化里运动控制的规律并允许它实现二阶动态误差指数收敛到零。然而，在电液系统中，力和电流之间并没有任何简单的关系。我们很有兴趣研究这样一个系统是否会用错误的定动力学所描述。

A．反馈控制计划

在基于模型的阻抗方法中，一个新的轨迹计算方法是被一个阻抗滤波器计算和推导出来的，这个新的运动轨迹的设计包括一整套的阻抗参数的设计，这种方式非常有利于跟进测试其性能。反馈控制器使用逆运动学机制。为移动平台所需的笛卡尔轨迹是驱动器长度的轨迹。执行器将错误的长度和速度送入阻抗滤波器。在这整个设计当众驱动器的长度反馈将会被用到。

一个典型的系统的特点是由一个二阶系统组成的。在一般情况下理想的特点可以延长考虑到虚拟点的速度作为时间函数，当然其中也包括有速度，加速度与力的误差的控制方案。目前的的阻液虑波方法用于电液伺服机构。可以描述为：

期中M d 表示理想的6×6惯性矩阵，B d和K d 分别表示6×1阻尼和刚度向量（理想的阻尼矩阵和向量参数）描述所需的二阶特性。L e 表示新6×1所以需的阻抗轨迹矢量，这取决于理想值

L des 和接触力。F env 表示的是可行性的6×1环境力向量体系。它可以通过测力传感器而近似的写出表达式为：

期中K env 表示的是6×6的角矩阵，它象征着对应环境的刚度l env 表示的是6×1的向量，这是一个虚拟的环境。

B．前馈控制计划

前馈控制计划可以添加到整个控制计划当众来进一步减少所需要的轨迹偏差。而这个6×1的电流矢量必须由这种物理设备的特点所决定，包括接触式和非接触式系统制度，所模拟的控制方式如图6所示

图6 完整的基于模型的六自由度电液伺服斯图尔特机构阻抗控制器示意图前馈输入伺服阀电流是用液压伺服系统的简化模型确定的。使用一个简化的模型前馈回路会产生几乎相同的系统响应的完整模型，此外，这种方法的主要优点是在模拟器所需的计算能力显著下降。

4．结论

以6×6电液伺服斯图尔特平台为模型的阻抗对称关节位置控制起器的正在被开发研究，动态模型被用来描述斯图尔特平台的刚体和液压驱动系统，并得到其动态方程。被列入模型中的伺服阀模型和摩擦模型先进的控制设计采用刚体和驱动动态以及伺服阀的输入电流向量而去分析形式。控制规律由两个单独的信号组成，即前馈和反馈信号。阻抗过滤器修改所需的轨迹，是根据指定的特性而决定的。修改后的轨迹被送入系统模型，以减少非线性液压动力学影响。先进控制器的性能说明使用的是典型的轨迹。所拟议的方法可以被延伸为电动串行或者是闭环机器人和模

拟器。

六自由度摇摆平台

大黄蜂机器人六自由度摇摆台 大黄蜂机器人有限公司的六自由度平台系统由采用Stewart机构的六自由度运动平台、计算机控制系统、驱动系统等组成。六自由度运动平台（如下图）的下平台安装在地面上，上 平台为运动平台，它由六只电动缸支承，运动平台与电动缸采用六个虎克铰连接，电动缸与固定基座采用六个虎克铰连接，六只电动缸采用伺服电机驱动的电动缸。计算机控制系统通过协调控制电动缸的行程，实现运动平台的六个自由度的运动，即笛卡尔坐标系内的三个平移运动和绕三个坐标轴的转动。

各主要部分简述如下： 本设备主要由以下部分组成：运动上平台、下平台（基座）、电动缸及伺服 电机、驱动器系统、综合控制及监测系统。 各自功能如下： 上平台：是有效载荷的安装基面，提供六自由度的摇摆运动。 下平台：是六自由度摇摆台的安装基面，需要承受足够大的冲击力。 电动缸及伺服电机：通过控制电动缸活塞杆的行程，实现运动平台台体的六自由度运动，共6套。 驱动器系统：接收用户控制指令，通过控制伺服电机的输入，对伺服电机的输出转速和转角进行控制，达到控制电动缸活塞杆出速度和行程的目的，共6套。 综合控制监测系统：硬件为用户计算机，软件为研制方配合开发；同时，它 还对平台的运动过程进行监测，预防和处理系统的异常情况。

平台总体运动能力指标如上表，具体表述如下： a.平台定位精度及重复定位精度为0.5mm及0.1mm； b.平台转动精度及重复转动精度为0.1°及0.05°； c.行程回差小于0.2mm； d.平台X方向运动速度可从0mm/s到250mm/s连续变化；YZ方向运动 速度可从0mm/s到250mm/s连续变化； e.单支杆可承受轴向力不小于700N； f.单支杆的运动速度可从0m/s到250mm/s连续变化； g.平台中位位置固有频率：不小于40Hz； h.机械组件需具有开放性，可拆卸组装； i.机械设计安全系数不小于 2.0，驱动裕度不小于 3.0； j.额定载荷下，全行程往复工作寿命不小于1×104次，存储寿命不小于48月；

六自由度运动模拟器

基于模型的阻抗控制六自由度电液斯图尔平台 摘要—本文详细描述了一个以模型为基础的阻抗控制六自由度电液斯图尔平台，刚体和电液伺服阀模型，包括所用伺服阀模型和一套完整的系统方程，也包括摩擦和泄漏液压原件。所设计的控制器是采用系统动力学和液压模型产生伺服阀电流。控制规则包括反馈和前馈两个单独的部分。根据指定的特性阻抗过滤器会修改所需的轨迹，修改后的轨迹被送入系统模型，以减少非线性液压动力的影响。提出了模拟的典型期望轨迹，并得到了拥有良好性能的控制器。 1．导言 最早的6自由度（DOF）斯图尔特高夫平台是在1954年发明的。在1965年，样机的平行机构被用做一个具有六自由度运动平台的飞行模拟器。此后，许多关于这种机构以及相关研究被发表，该机构可以是电动也可以是液动。许多研究人员已经研究了斯图尔特平台的动力学和运动学。然而驱动力却没有被考虑完全。虽然电动斯图尔平台已被广泛运用，但是很少有研究是关于包括驱动和控制的完整动力学。 阻抗控制被认为是一种积极的兼容的运动控制，主要需要行业应用并于周围环境相互作用，例如数控机床，铣床等。这种控制器同时具有安全性和灵活性，相对而言是首选。 液压科学与控制相结合，得到了新的液压系统的应用。这也是为什么液压系统会被作为一些工业和移动式应用机电驱动的首选。包括它们大批量快速生产的能力，它们的耐久性和刚度，还有他们的响应速度，液压体系不同于机电体系，在液压体系中力或例句输出与执行器的电流是不成真比的，因此，液压执行器不能作为力矩的来源模仿，但是可以作为受控阻抗，所以，要设计出了控制机器人的控制器。驱动力/力矩的虚拟设置在这里始终不可行。 控制技术被用来补偿电动液压伺服系统的非线性。研究人员已经提出了关于液压伺服系统的非线性自适应控制技术的假设、反推以及方式。一个强力的控制器是在非线性定量反馈理论的基础上设计的，已被工业液力执行机构所实现，同时考虑了系统和环境的不确定性。一个电动机械手控制的统一方式适用于任何提案。运动学约束议案，以及机机械臂及其环境之间的动态交互研究已经通过审查。制定所需的机械臂阻抗技术和对一个给定应用程序选择适当的阻抗的技术的最优化理论已经被提出。这里有两种控制机电驱动高夫斯图尔特并行平台机械阻抗的空间几何方法，第一种基于球形位置函数，第二种则是利用指数映射关联有限位移与扭转位移平衡的平台。 一个基于模型的高性能的压接头液压伺服系统前馈反馈阻抗控制器已经被提出，在这里，一个阻抗根据在自由空间或空间接触的行为来调整过滤器所需的轨迹，类似已提交的工作，其中基于位置阻抗控制器工业液压机械手已开发。此外，阻抗控制器研究已在遥控轮式液压伺服系统和重型工程中实施。 在这篇论文中，提及了一种基于模型的六自由度电液伺服斯图尔特关节对称平台阻抗控制器，用于描述刚体斯图尔特平台和液压驱动系统，对比其它方法，这里有伺服模型和摩擦模型。先进的控制方案在分析方案时，应用了刚体、驱动力学和伺服阀的输入电流矢量。控制规律包括两个信号，反馈信号和前馈信号。根据指定的行为阻抗过滤器会修改所需的轨迹。修改后的轨迹被送入系统模型，以减少非线性液压动力的影响。现金控制器的性能说明使用了典型的轨迹。拟议的方法可以扩展到串行或闭链机器人和模拟器。 2系统建模 在本节中，研究了六自由度电液伺服斯图尔特平台的动态模型，这是一个由支架和六个线性驱动器组成的闭环运动体系，该体系的原理如图1所示：

六自由度运动平台方案设计报告

编号 密级内部阶段标记 C 会签 校对 审核 批准六自由度运动平台 方案设计 名称

内容摘要： 针对YYPT项目在原理样机出现的问题，对YYPT原理样机从结构设计、伺服系统等方面进行优化设计，以满足设计及使用要求。 主 YYPT 优化 题 词 更改单号更改日期更改人更改办法 更 改 栏

1概述 YYPT原理样机用原库房留存的345厂的直流电机作为动力源，直流驱动器及工控机作为控制系统元件，采用VB软件进行控制软件的编制，因设计及器件选型的原因，导致YYPT原理样机，在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求，现在此基础上进行优化方案的设计。 2 原理样机技术状态 2.1 原理样机方案 2.1.1 组成 原理样机采用工控机作为系统的控制单元，工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡，驱动器采用AMC公司的型号为12A8的伺服驱动器，并配有直流可调电源其输出电流可达到150A，采用KH08XX（3）电动缸作为运动平台的六条支腿，电动缸上安装有电阻尺作为位置反馈器件，上平台与电动缸连接采用球笼联轴器，下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.1。 序号产品名称型号厂家数量备注 1 电动缸KH08XX（3）西安方元明 6 安装345厂电机 2 电阻尺LTS-V1-375 上海徳测 6 3 驱动器50A8 AMC 6 3 A/D卡PCI1716 研华 1 4 D/A卡PCI1723 研华 1 5 工控机610H 研华 1 6 直流电源 1 2.1.2 结构方案 六自由度运动平台是由六条电动缸通过虎克铰链和球笼万向节联轴器将上、下两个平台连接而成，下平台固定在基础上，借助六条电动缸的伸缩运动，完成上平台在三维空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。

六自由度

物体在空间具有六个自由度，即沿X、Y、Z三个直角坐标轴方向的移动自由度和绕这三个坐标轴的转动自由度。因此，要完全确定物体的位置，就必须清楚这六个自由度。 六自由度运动平台是由六支作动筒，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六支作动筒的伸缩运动，完成上平台在空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。可广泛应用到各种训练模拟器如飞行模拟器、舰艇模拟器、海军直升机起降模拟平台、坦克模拟器、汽车驾驶模拟器、火车驾驶模拟器、地震模拟器以及动感电影、娱乐设备等领域，甚至可用到空间宇宙飞船的对接，空中加油机的加油对接中。在加工业可制成六轴联动机床、灵巧机器人等。由于六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等等一系列高科技领域，因而六自由度运动平台的研制变成了高等院校、研究院所在液压和控制领域水平的标志性象征。 空间运动的目标是实现平台在空间运动的三个姿态角度和三个平动位移，即俯仰、滚转、偏航、上下垂直运动、前后平移和左右平移，及六个姿态的复合运动姿态。而空间目标是通过六个液压缸的行程实现的，这就需要一个空间的运动模型完成空间运动的转换，假设空间运动的目标俯仰、滚转、偏航、上下垂直位移、前后平移和左右平移用α，β，γ，X，Y，Z表示，六个油缸的行程用 L(i), (i＝1、2、3、4、5、6)表示。整个运动模型如下： L（i）＝TT（α，β，γ，X，Y，Z） 其中，TT是一个空间转换矩阵模型。由此实时算出每一运动时刻液压油缸的行程。液压油缸的理论行程再通过D/A接口的转换，给出实际行程值。 多自由度运动控制 多自由度控制系统中，自由度最多为六自由度，并且六自由度运动控制难度最大，设备及系统最复杂，下面主要介绍我公司设计、生产的六自由度运动台。 六自由度运动平台是由六支直线伺服电动缸，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六只伺服电动缸）执行器）的伸缩运动，完成上平台在空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出

并联六自由度运动平台

并联六自由度运动平台 1．概述 并联六自由度运动平台通过六个驱动缸（伺服缸或电动缸）的协调伸缩来实现平台在空间六个自由度的运动，即平台沿x、y、z向的平移和绕x、y、z轴的旋转运动（包括垂直、水平、横向、俯仰、侧倾和旋转六个自由度的运动），以及这些自由度的复合运动。并联六自由度运动平台可用于机器人、飞行模拟器、车辆驾驶模拟器、新型加工机床、及卫星、导弹等飞行器、娱乐业的运动模拟（动感电影摇摆台）、多自由度振动摇摆台的精确运动仿真等。 图0-1：六自由度及其坐标系定义图 我公司通过自行设计、安装调试，并开发控制软件，同时采用进口关键件对并联六自由度运动平台进行研究开发，目前已完成多套六自由度运动平台应用，典型应用有列车风档液压仿真试验台、F1国际赛车运动仿真台、汽车驾驶模拟器、飞机和飞碟运动模拟器、振动谱试验、海浪模拟试验等。 六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等一系列高科技领域，是液压及控制技术领域的顶级产品。 2．系统组成 2.1液压伺服类 典型的液压式并联六自由度运动平台主要由机械系统、液压系统、控制系统硬件和控制系统软件四部分组成。

机械系统主要包括：承载平台、上下连接铰链、固定座。 液压系统主要包括：泵站系统、伺服阀、驱动器、伺服油缸和阀块管路。 控制系统硬件主要包括：实时处理器、伺服控制单元、信号调理单元、监控单元和泵站控制单元。 控制系统软件包括：实时信号处理单元、实时运算单元、伺服控制和特殊要求处理单元。 2.2 电动伺服类 电动式并联六自由度运动平台则将伺服油缸用电动缸代替，而伺服阀、泵站系统及阀块管路等则相应取消，增 加运动控制单元。具有系统简洁、响应速度快等优点，是多自由度平台今后重点发展的方向。 3．主要技术参数 以下参数为液压类平台典型值，具体可按用户要求设计制造。 3.1平台主要参数 平台最大负载：静态≥2000KG，动态≥3000KG。 上平台球铰分布园直径1400mm，相邻球心距离157mm； 下平台球铰分布园直径1600mm，相邻球心距离167mm； 伺服缸最小球铰球心距离800mm，最大长度1200mm；（采用Φ63/45~400缸体）。 平台初始高度约700mm。 3．2 泵站技术指标 额定流量：90L/min 最大系统压力：12Mpa； 泵站电机功率：22KW； 空间尺寸：1400×1200×1320 3.3 运动参数 伺服缸运动速度≥200mm/S；有效行程≥400mm。 主要运动参数如下表：

6自由度控制算法

由于六自由度位置姿态调整平台动力学特性和串联机器人是相通的,所以可以借鉴。增强型PD控制器,这种控制器是在一个线性PD控制的基础上加上沿期望轨迹计算的名义动力学前馈部分以及一个非线性补偿部分,它的最大优点是可以根据规划好的期望轨迹离线计算前馈补偿部分,从而降低实时计算的计算量。计算力矩控制方法,它通过计算力矩的方式控制非线性系统沿期望轨迹运动,如果机器人动力学模型是准确的,计算力矩控制器可以实现动态解耦,并得到一个指数稳定的闭环动力方程,从而实现跟踪误差的指数收敛。 在并联机器人的控制策略中,除了常用的PID控制之外,还有自适应控制，滑模变结构控制，鲁棒控制以及智能控制等控制方法。 基于滑模控制的方法 在具有不确定性的系统的研究和应用中，滑模控制一直是一个非常有效的控制方法。滑模控制也叫变结构控制，其本质是一类特殊的非线性控制，且非线性表现为控制的不连续性。这种控制策略与其他控制的不同之处在于系统的“结构”不是一成不变的，而是可根据系统当前的状态有目的地不断变化。对于具有信号传输时延的交互控制遥操作系统，也可以应用滑模控制来实现。只要知道时延大小，滑模控制就可以实现变时延情况下的遥操作系统的稳定控制。由于滑动模态与系统对象参数及扰动无关，因此滑模控制具有响应快、对应参数变化及扰动不灵敏、无需系统在线辨识、物理实现简单等优点。 鲁棒控制 由于遥操作系统中操作对象的不确定性，以及操作任务的实时变化，导致遥操作系统的特性和参数随工作状态和工作环境的变化而变化，这样就无法得到精确的描述遥操作系统特性的数学模型，给控制系统的设计带来困难。鲁棒控制设计的目标就是在模型不精确和存在其他变化因素的条件下，使系统仍能保持预期的性能。因此鲁棒控制在遥操作系统中发挥了巨大作用，它较大程度地消除了主观上认识的模型和真实的被控对象之间的误差和不确定性。 基于干扰观测器(DOB)的鲁棒运动控制方法由Ohnishi提出,目前广泛应用于各类电动高精度机械伺服系统"干扰观测器设计基于被控对象的开环数学模型,其基本思想是将外部力矩干扰及模型参数变化造成的实际对象与名义模型输出的差异,统统等效到控制输入端,即观测出等效干扰,在控制中引入等量的补偿,实现对各种干扰的完全抑制,同时还可以减弱非线性环节对伺服系统性能的影响,具有很强的鲁棒性。 六自由度并联平台运动控制器的设计可以分为基于铰接空间控制和基于工作空间控制两大类。 基于铰接空间的控制器设计主要依靠平台机构的运动学关系和驱动装置的动态模型,而不考虑六自由度平台的动力学模型,它假设六个液压缸是独立、无耦合的关系,对每个液压伺服系统分别设计控制器而不用考虑其它关节的影响,这就使得并联平台的控制器设计任务转化为一系列单轴伺服系统的控制器设计。 基于工作空间的控制器设计则需要进行平台动力学分析,建立整个并联平台系统的动力学模型,在给定了平台期望的运动轨迹后,求出按照期望轨迹运动所需的力或力矩,然后控制各个液压伺服系统的驱动装置输出所求出的力或力矩,从而使平台按照期望轨迹运动。 常规PID控制 常规PID目前是最常用的工业控制方法，PID控制器各校正环节的作用

六自由度机器人运动分析及优化

本科毕业论文（设计） 题目（中文）六自由度机器人运动分析及优化 （英文） Motionanalysis and optimization of 6-DOF robot 学院信息与机电工程学院院 年级专业 2013级汽车服务工程（中德）） 学生姓名吴子璇正 学号 130154494 7 指导教师安康安 完成日期 2017 年 3 月

摘要 当今世界，工业化日趋成熟，机器人被广泛的应用于各行各业，最常用到的有四自由度，六自由度机器人。其中，自动化水平较高的汽车制造业和电子装配业经常常常要使用到六自由度机器人。因此对其实施运动学分析，是进行科学设计的基础，也是降低机器人生产成本，优化机器人运动轨迹的前提。此外，运动分析过程有效的模拟了机器人运动的真实情况，有助于提供有效可行的优化方案。本文主要探讨六自由度机器人的运动分析，基于经典运动学以及动力学的研究方法概念，首先通过solidworks做出机械臂各部分零件的三维图，然后通过SolidWorks装配出六自由度机器人机械臂的三维模型。通过该模型，选取其中一个关节和底座，并用SolidWorks进行运动学分析，对六自由度机器人的运动学和动力学计算方法进行了仿真验证。最后得到六自由度机器人的其中一个自由度的运动仿真实例。通过对该运动仿真实例的分析，得出最佳优化方案，优化机器人的运动轨迹提高机器人的工作效率，降低机器人生产成本。 关键词：六自由度机器人；运动分析；运动学；动力学；

目录 摘要................................................. I Abstract ............................... 错误!未定义书签。 1 绪论 (1) 1.1 课题背景及研究的目的和意义 (1) 1.2机器人国内外发展现状及前景展望--------------------------1 2 六自由度机器人运动学分析 (4) 2.1六自由度机器人的结构-------------------------------------1 2.2运动学分析----------------------------------------------1 3 六自由度机器人动力学分析 (6) 3.1综述----------------------------------------------------3 3.2机器人动力学研究方法------------------------------------3 3.2.1几项假设-------------------------------------------3 3.2.2目标-----------------------------------------------4 3.2.3数学工具-------------------------------------------5 3.3动力学原理----------------------------------------------3

六自由度汽车驾驶运动模拟器设计

摘要 汽车驾驶模拟器是一种用于汽车产品开发、“人—车—环境”交通特性研究或驾驶培训的重要工具。近年来，由于具有安全性高、再现性好、可开发性强、成本低等显著特点，研究开发驾驶模拟器已经成为国内外一个重要发展方向。 本文在查阅国内外大量资料的基础上，结合老师的研究课题主要对六自由度汽车驾驶模拟器液压系统部分进行设计。六自由度汽车运动模拟器采用液压伺服阀控制液压缸来驱动模拟平台的运动，以实现汽车驾驶模拟器运动姿态模拟。本文主要进行机械机构的设计、液压伺服系统设计、液压泵站设计和液压缸的设计等。 通过模拟器的机构设计和驱动液压伺服系统设计，结合电气系统能够实现汽车在不同运行状态的模拟，当驾驶员坐在驾驶舱系统的座椅上进行模拟驾驶时，完全能够感受到实际汽车驾驶的各种体感，为实车训练驾驶提供了可替代的模拟平台；本设计也为今后的进一步研究及其在娱乐模拟器、动感电影等产业的实际推广和应用方面奠定了基础。 关键词：汽车驾驶模拟器六自由度运动平台液压伺服系统运动姿态控制

Abstract The Automobile-driving i an important tool which used for the development of auto mobile product and the study of the transportation characteristics of “man-car-environment”or the driver training .In recent years, the study of the automobile-driving simulator used for development has become an important development direction in the world because of the notable characteristics of high safety, well reappearance of scene, easy to develop and low cost. This article is based on searching the large quantity of information about at home and abroad, and combines with the tea cher’s research task which mainly designs the part of 6-dof driving Simulator of hydraulic system .The 6-dof motion simulator adopts valves of hydraulic servo to control actuator to drive the movement of driving simulation platform, and to achieve the movement posture simulation of the automobile driving simulator. This article is mainly about the designing of machine, the system of hydraulic servo, hydraulic pump station, and actuator and so on. According to the designing of agencies of simulator and hydraulic servo system, it can combines the electrical system which can bring out the imitation of cars in different movement conditions, when the driver simulating drive on the seat of cockpit system, you can feel the feeling of driving a true car, and it also offer the simulator platform which can be replaced for true driving training. At the same time, this designing is also establishes for the further researches and the practice extension and use. Keywords:Driving-automobile simulator, 6-dof of motion platform, the system of hydraulic servo, the control of campaign attitude

六自由度运动平台的仿真研究

六自由度运动平台的仿真研究 天津工程机械研究院 杨永立 摘要：本文分析了六自由度运动平台分别采用球铰链和万向节铰链进行连接时的自由度，运用欧拉角、旋转变换的方法推导出位置反解方程，介绍了数值迭代法进行位置正解的过程。 关键词：并联，局部自由度，位置反解，位置正解。 1. 简介 运动平台按结构形式可分为串联和并联两大类。与串联形式相比，并联形式具有刚度大、承载能力强、结构简单、运动负荷小、能实现包括横移、纵移、升沉等多个自由度运动等特点。同时，串联形式的优点也很明显，其具有运动空间大，测量精度高，运动、受力分析相对简单、控制、测量的实现相对容易，且每个自由度都能独立运动等特点。 六自由度运动平台（如图1所示）是由六条油缸通过万向节铰链（或球铰链）将上、下两个平台连接而成，下平台固定在基础上，借助六条油缸的伸缩运动，完成上平台在三维空间六个自由度（X， Y，Z，α，β，γ）的运动，从而可以 模拟出各种空间运动姿态。 2. 自由度的确定 若在三维空间有n个完全不受约束 的物体，任选其中一个作为固定参照物， 因每个物体相对参照物都有6个运动自 由度，则n个物体相对参照物共有6(n-1) 个运动自由度。若在所有物体之间用运 动副联接起来组成机构，设第i个运动副 的约束为u i（1到5之间的整数），如果 运动副的总数为g，则机构的自由度M为：

∑=--=g i i u n M 1)1(6 利用上述公式计算一下如图1所示运动平台(采用球铰链)的自由度数。将油缸分解为缸筒和活塞杆，则总的构件数n=14，油缸与上下平台之间的连接为12个球铰链（约束为3），缸筒和活塞杆构成6个既可以相对移动，又可以相对转动的运动副（约束为4），则平台的自由度M 为： ∑=--=g i i u n M 1)1(6=6 (14－1)－(3×12＋4×6)=18 计算结果出人意料，平台似乎无法只通过六条油缸进行驱动。但是，如果保持上平台和缸筒固定不动，由球铰链的特性可知，活塞杆仍然可以相对其轴线转动；同理，缸筒也具有同样的效应。实践证明，这种转动并不影响上平台的空间运动姿态，因此属于局部自由度。 在六自由度运动平台的实际设计中，由于球铰链 的刚度差，结构不稳定，所以一般采用万向节铰链（如 图2所示，约束为4）来代替图1中的球铰链，则自由 度M 为： ∑=--=g i i u n M 1)1(6=6 (14－1)－(4×12＋4×6)=6 3. 六自由度运动平台空间姿态的解算 要实现对平台空间姿态的控制和测量，必须掌握它两个方向上的解算方法，即位置反解和位置正解。 3.1 位置反解（逆向解）： 已知输出件的位置和姿态，求解输入件的位置称为机构的位置反解。在运动平台的实际应用当中，用户所给定的一般都是平台的六个空间姿态参数X ，Y ，Z ，α，β，γ，然而要实现对平台的控制，需要的是六条油缸的长度L 1、L 2…L 6，这正好是已知输出求输入，属于位置反解。也就是说，要实现对平台空间姿态的控制，就必需推导出平台的位置反解方程。 如图1所示，在上平台建立动坐标系o-xyz ，在下平台建立静坐标系O-XYZ ， 图2 万向节铰链

六自由度运动平台设计方案

六自由度运动平台设计 方案 1概述 YYPT原理样机用原库房留存的345厂的直流电机作为动力源，直流驱动器及工控机作为控制系统元件，采用VB软件进行控制软件的编制，因设计及器件选型的原因，导致YYPT原理样机，在速度、精度、运动规律上等几个技术指标无法满足原规定的指标要求，现在此基础上进行优化方案的设计。 2 原理样机技术状态 2.1 原理样机方案 2.1.1 组成 原理样机采用工控机作为系统的控制单元，工控机内配有研华PCI1716和PCI1723作为A/D和D/A模拟量卡，驱动器采用AMC公司的型号为12A8的伺服驱动器，并配有直流可调电源其输出电流可达到150A，采用KH08XX（3）电动缸作为运动平台的六条支腿，电动缸上安装有电阻尺作为位置反馈器件，上平台与电动缸连接采用球笼联轴器，下平台与电动缸连接采用虎克铰链方式。具体产品组成表见表2.1。 序号产品名称型号厂家数量备注 1 电动缸KH08XX（3）西安方元明 6 安装345厂电机 2 电阻尺LTS-V1-375 上海徳测 6 3 驱动器50A8 AMC 6 3 A/D卡PCI1716 研华 1 4 D/A卡PCI1723 研华 1 5 工控机610H 研华 1

6 直流电源 1 2.1.2 结构方案 六自由度运动平台是由六条电动缸通过虎克铰链和球笼万向节联轴器将上、下两个平台连接而成，下平台固定在基础上，借助六条电动缸的伸缩运动，完成上平台在三维空间六个自由度（X ，Y ，Z ，α，β，γ）的运动，从而可以模拟出各种空间运动姿态。 图1 六自由度平台外形图 a ）球笼联轴器（如图2所示） 采用球笼铰链与上平面连接。球笼铰链结构简单、体积小、运转灵活、易于维护。 初选球笼铰链型号BJB （JB/T6139-1992），公称转矩Tn=2000N/m ，工作角度40度，外径D=68mm ，轴孔选用圆柱孔d=24mm ，总长度L1=148mm ，转动惯量为0.00008kg.m 2，重量5kg 。 球笼联轴器 电动缸 虎克铰链 上动平台 下静平台

六自由度舰船运动模拟器随机海浪谱模拟

六自由度舰船运动模拟器随机海浪谱模拟 皮阳军1,　王宣银1,　罗晓晔2,　顾　曦1 (1浙江大学流体传动及控制国家重点实验室　杭州,310027)(2杭州职业技术学院模具研究所　杭州,310018) 摘要　为了测试随机海浪引起的振动对舰载设备性能和可靠性的影响,提出利用六自由度舰船运动模拟器复现随机海浪谱,对舰载设备进行环境模拟试验。针对六自由度舰船运动模拟器的实际情况,提出双闭环控制方法,利用实时正解代替输出传感器。研究了基于谱均衡和时域随机化的随机海浪谱驱动信号生成技术,并在六自由度舰船运动模拟器上进行试验。试验结果表明,该方法能在六自由度舰船运动模拟器上模拟随机海浪谱,频域复现精度达到±1dB。 关键词　六自由度　模拟器　海浪谱　可靠性　随机振动 中图分类号　T P242　T P391.76 引　言 环境模拟试验是设备可靠性验证的重要组成部分,在设备的研发和可靠性验证中具有重要作用[1-2]。舰船在海洋中主要受到海浪扰动而产生振动,需要舰船运动模拟器来模拟海浪产生的振动。海浪引发的振动属于随机振动,而海浪功率谱密度是海浪重要统计特征之一[3]。因此,海浪随机振动的模拟又称为海浪功率谱密度的模拟。 国外公司已经掌握了随机振动试验的控制技术,有较为成熟的产品[4-5]。Welar atna[6]介绍了随机振动试验的控制算法。Vaes[7]介绍了一种路面振动模拟的振动台。国内学者主要对随机振动试验中的理论进行了研究。蒋瑜等[8]对超高斯真随机信号的生成技术进行了研究。王述成等[9]对随机振动试验中的时域随机化技术进行了研究。这些研究主要集中在宽带随机振动控制,振动台的行程一般较短。研究表明,海浪谱为窄带信号,频谱主要集中在低频段,在时域内随机信号的幅值较大,因此不能采用一般的振动台进行模拟。六自由度舰船运动模拟器具有输出力大、输出位移长的优点,满足海浪谱模拟的要求。国内外学者对并联六自由度平台进行了较为深入的研究,基于该平台的六自由度模拟器已经在航空、汽车和舰船模拟上得到了广泛的应用[10]。 本文根据六自由度模拟器的实际情况,利用位移传感器采集6个驱动杆长度,进行实时正解得到模拟器末端位姿。这种设计避免了安装加速度传感器,也方便在计算机内部进行位置闭环控制。 1　六自由度舰船运动模拟器 六自由度舰船运动模拟器主要由并联六自由度平台构成。如图1所示,并联六自由度平台由6根可伸缩液压缸分别和上、下平台以球铰和虎克铰连接。下平台固定,上平台可以模拟舰船的纵移、横移、垂荡、纵摇、横摇和艏摇六自由度运动。平台上、下铰点分别用B i,A i(i=1,2,…,6)表示。上、下平台的坐标系分别为运动坐标系O p X p Y p Z p和惯性坐标系O g X g Y g Z g。平台的结构参数如下:上、下铰分布半径为R1和R0;上、下铰点分布角为 1和 0;支链铰间距为q;零位时上平台高为h。 六自由度平台的输出与6个驱动关节的输入具有特定的映射关系。已知各个关节输入求取六自由度平台的输出称为正解问题。因此,试验系统采集6个驱动关节的位移,通过实时正解求出六自由度平台的输出位置,避免直接在输出端安装传感器。 2　随机海浪谱驱动信号生成原理 传统的舰船运动模拟器一般将海浪作为规则波或规则波的叠加进行处理,实际上海浪是不规则的 　第30卷第4期 2010年8月 振动、测试与诊断 Journal of Vibratio n,M easurement&Diagnosis V o l.30No.4 A ug.2010 国家自然科学基金资助项目(编号:50375139);新世纪优秀人才支持计划资助项目(编号:N CET-04-0545);浙江大学流体传动及控制国家重点实验室开放基金资助项目(编号:GZK F-2007004) 收稿日期:2009-06-16;修改稿收到日期:2010-03-12

六自由度机械手的坐标建立及运动学分析

第**卷第**期20**年*月 机械工程学报 JOURNAL OF MECHANICAL ENGINEERING Vo l.** No.* *** 20** DOI：10.3901/JME.20**.**.*** 六自由度机械手的坐标建立及运动学分析 摘要：从运动学分析的基础上着手研究轨迹控制的问题，利用运动学逆解的方式分析复杂轨迹运动的可行性和实用性。通过建立机械手的笛卡尔坐标系，推导出机械手的正、逆运动学矩阵方程，并研究了正、逆 运动学方程的解；在此基础上建立机械手的工作空间，并讨论其工作空间的灵活性和存在可能性。 因此本文的另一种方式对六自由度串联机械手的复杂运动控制问题进行研究，提出以机械手示教手柄引导末端执行器对复杂运动轨迹进行预设计。然后通过记录程序进行复杂轨迹的再实现，再对记录程序进行预修改，最终通过现有的程序进行设计编程完成复杂轨迹设计任务。并利用MATLAB对轨迹进行仿真，对比其实际与计算的正确性。 最后本设计通过六自由度串联机械手实现平面文字轨迹，得出其设计的方式。即首先利用示教手柄实现轨迹预设，记录预设轨迹程序，然后再对比程序初始化坐标进行手动编程。 关键词：六自由度机械手，笛卡尔坐标系，运动学方程，仿真，示教手柄 The coordinates of six degrees of freedom manipulator and kinematics analysis is established WU Yanchao JIN Yuanxun ZHAO Xin LI Daohai SONG Ping MENG Ya ABSTRACT：T his article based on the analysis of kinematics to study the trajectory control problems, use of inverse kinematics of the complex mode of tracking movement of the feasibility and practicality. Through the establishment of the manipulator Cartesian coordinates, derived manipulator is the inverse kinematics matrix equation and the study is the inverse kinematics of the equation solution on the basis of this establishment manipulator working space. And discuss their work space The flexibility and the possibility exists. So in another way to the six degrees of freedom series manipulator motion control the complex issues of research, to handle the machinery Shoushi guide for the implementation of the end of the complex pre-designed trajectory. Then track record of the complicated procedure to achieve, and then record the pre-amended procedures.The eventual adoption of the existing procedures designed trajectory design of complex programming tasks. And using MATLAB simulation of the track, compared with its actual calculation is correct. The final design through six degrees of freedom series manipulator track to achieve flat text, draw their design approach. That is, first of all use of teaching handle achieve trajectory default the track record of default procedures, and then compared to manual procedures initialized coordinate programming. key words：Six degree-of-freedom manipulators，Cartesian coordinates， Equations of motion，Simulation， Demonstration handle

六自由度运动平台正解(几何法)

六自由度运动平台正解(几何法) 1. 对上平台（运动平台）进行扩展，示意如下： Pic 1 上平台示意图 由于确定一个平面状态只需要三个点，因此获得C1,C2,C3坐标，即可确定平面状态。 如图，h1,h2均为已知量，设L h k /1=，212*h h L +=，),,(i i i i z y x C =。 设下平台各点坐标为),,(i i i i s n m B =，设各轴长为i i i l B A =。 于是问题简化为：已知：L k l B i i ,,,，求解i C 。 2. 建立方程组 2.1 i l 相关 对于1l ，分析如下：

Pic 2 单轴示意图 由图可知：向量3111111111*C C k C B A C C B A B +=+=， 即，1111111131313),,(),,(l s z n y m x z z y y x x k =---+--- 所以： )1......(0])1([])1([])1([21211321132113=---++--++--+l s z k kz n y k ky m x k kx 同理有： ) 6......(0])1([])1([])1([)5......(0])1([])1([])1([)4......(0])1([])1([])1([) 3......(0])1([])1([])1([) 2......(0])1([])1([])1([2626312631263125253225322532242423242324232323212321232122221222122212=---++--++--+=---++--++--+=---++--++--+=---++--++--+=---++--++--+l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx l s z k kz n y k ky m x k kx 2.2 L 相关 ) 9......(0)()()()8......(0)()()()7......(0)()()(222322322322312312312221221221=--+-+-=--+-+-=--+-+-L z z y y x x L z z y y x x L z z y y x x 3. 求解 3.1 联立方程组（1）-（9），牛顿迭代法解方程组，即可求的i C ， 取0>i z ，可得唯一解。 3.2 由i C 求出平台姿态 根据实际情况，建立坐标系如下

六自由度液压运动平台的自动控制

编号 无锡太湖学院 毕业设计（论文） 题目：六自由度液压运动平台的自动控制信机系机械工程及自动化专业 学号： 学生姓名： 指导教师：（职称：副教授） （职称：） 2013年5月25日

无锡太湖学院本科毕业设计（论文） 诚信承诺书 本人郑重声明：所呈交的毕业设计（论文）六自由度液压运动平台的自动控制是本人在导师的指导下独立进行研究所取得的成果。有关观点、方法、数据和文献等的引用已在文中指出，并与参考文献相对应。其内容除了在毕业设计（论文）中特别加以标注引用，表示致谢的内容外，本毕业设计（论文）不包含任何其他个人、集体已发表或撰写的成果作品。 班级： 学号： 作者姓名： 2013 年5 月25 日

无锡太湖学院 信机系机械工程及自动化专业 毕业设计论文任务书一、题目及专题： 1、题目六自由度液压运动平台的自动控制 2、专题 二、课题来源及选题依据 六自由度运动平台，由于有极为广阔的应用前景，六自由度运动平台是由六支油缸，上、下各六只万向铰链和上、下两个平台组成，下平台固定在基础上，借助六只油缸的伸缩运动，完成上平台在空间六个自由度（X，Y，Z，α，β，γ）的运动，从而可以模拟出各种空间运动姿态，可广泛应用到各种训练模拟器如飞行模拟器、舰艇模拟器、海军直升机起降模拟平台、坦克模拟器、汽车驾驶模拟器、火车驾驶模拟器、地震模拟器以及动感电影、娱乐设备等领域，甚至可用到空间宇宙飞船的对接，空中加油机的加油对接中。在加工业可制成六轴联动机床、灵巧机器人等。由于六自由度运动平台的研制，涉及机械、液压、电气、控制、计算机、传感器，空间运动数学模型、实时信号传输处理、图形显示、动态仿真等等一系列高科技领域，因而六自由度运动平台的研制变成了高等院校、研究院所在液压和控制领域水平的标志性象征。 三、本设计（论文或其他）应达到的要求： 1．查阅资料，了解国内外多自由度运动平台的现状和发展趋势。

六自由度机器人结构设计

六自由度机器人结构设计、 运动学分析及仿真 学科：机电一体化 姓名：袁杰 指导老师：鹿毅 答辩日期： 2012.6 摘要 近二十年来，机器人技术发展非常迅速，各种用途的机器人在各个领域广泛获 得应用。我国在机器人的研究和应用方面与工业化国家相比还有一定的差距，因此 研究和设计各种用途的机器人特别是工业机器人、推广机器人的应用是有现实意义 的。 典型的工业机器人例如焊接机器人、喷漆机器人、装配机器人等大多是固定在 生产线或加工设备旁边作业的，本论文作者在参考大量文献资料的基础上，结合项 目的要求，设计了一种小型的、固定在AGV 上以实现移动的六自由度串联机器人。 首先，作者针对机器人的设计要求提出了多个方案，对其进行分析比较，选择

其中最优的方案进行了结构设计；同时进行了运动学分析，用D-H 方法建立了坐标变换矩阵，推算了运动方程的正、逆解；用矢量积法推导了速度雅可比矩阵，并计算了包括腕点在内的一些点的位移和速度；然后借助坐标变换矩阵进行工作空间分析，作出了实际工作空间的轴剖面。这些工作为移动式机器人的结构设计、动力学分析和运动控制提供了依据。最后用ADAMS 软件进行了机器人手臂的运动学仿真，并对其结果进行了分析，对在机械设计中使用虚拟样机技术做了尝试，积累了 经验。 第1 章绪论 1.1 我国机器人研究现状 机器人是一种能够进行编程，并在自动控制下执行某种操作或移动 作业任务的机械装置。 机器人技术综合了机械工程、电子工程、计算机技术、自动控制及 人工智能等多种科学的最新研究成果，是机电一体化技术的典型代表，是当代科技发展最活跃的领域。机器人的研究、制造和应用正受到越来越多的国家的重视。近十几年来，机器人技术发展非常迅速，各种用途的机器人在各个领域广泛获得应用。 我国是从 20 世纪80 年代开始涉足机器人领域的研究和应用的。1986年，我国开展了“七五”机器人攻关计划。1987 年，我国的“863”计划将机器人方面的研究列入其中。目前，我国从事机器人的应用开发的主要是高校和有关科研院所。最初我国在机器人技术方面的主要