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

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

天津工程机械研究院

杨永立

摘要：本文分析了六自由度运动平台分别采用球铰链和万向节铰链进行连接时的自由度，运用欧拉角、旋转变换的方法推导出位置反解方程，介绍了数值迭代法进行位置正解的过程。

关键词：并联，局部自由度，位置反解，位置正解。

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 万向节铰链

那么，上平台的运动可分解为随o-xyz 坐标原点o 沿O-XYZ 三个坐标轴方向上的平移（X 、Y 、Z ），以及绕坐标轴的旋转（α，β，γ）。为了避免发生角度间的“耦合”，一般采用欧拉角来描述刚体的旋转状态，而欧拉角的定义又随旋转次序的不同而不同。本文将欧拉角定义为依次绕z 轴旋转γ，绕y 轴旋转β，绕x 轴旋转α。下平台各铰点A1、A2、…A6的坐标（X A1,Y A1,Z A1）、（X A2,Y A2,Z A2）…（X A6,Y A6,Z A6）和上平台各铰点a1、a2、…a6的动坐标（x a1,y a1,z a1）、（x a2,y a2,z a2）…（x a6,y a6,z a6）为已知，只要求出对应姿态参数X ，Y ，Z ，α，β，γ的上平台各铰点的静坐标（X a1,Y a1,Z a1）、（X a2,Y a2,Z a2）…（X a6,Y a6,Z a6），运用两点间距离公式便可以求出L 1、L 2…L 6。

以A1和a1为例来计算与其相连的油缸的长度L 1。在如上所述对运动进行分解的情况下，静坐标（X a1,Y a1,Z a1）和动坐标（x a1,y a1,z a1）有如下变换公式：

[]⎥⎥⎥⎦

⎤⎢⎢⎢⎣⎡+⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡⨯=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡Z Y X z y x T Z Y X a a a a a a 111111 其中[T]是关于α、β、γ的旋转变换矩阵，公式中只有矩阵[T]未知，下面就来求该旋转变换矩阵。

a 绕z 轴旋转γ

b 绕y '轴旋转β

c 绕x ''轴旋转α

图3 欧拉角坐标系

根据本文定义的欧拉角，建立如图3所示的四个坐标系xyz o -、z y x o '''-'、z y x o ''''''-''、z y x o '''''''''-'''。首先绕z 轴旋转γ，其变换关系如下：

x=x 'cos γ-y 'sin γ

y=x 'sin γ+y 'cos γ

z=z '

写成矩阵形式为：

⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡'''⨯⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡-=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡z y x z y x 1000cos sin 0sin cos γγγγ=[C]⎥⎥⎥⎦

⎤⎢⎢⎢⎣⎡'''⨯z y x 绕y '轴旋转β，其变换关系为：

⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡''''''⨯⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡-=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡'''z y x z y x ββββcos 0sin 010sin 0cos =[B]⎥⎥⎥⎦

⎤⎢⎢⎢⎣⎡''''''⨯z y x 绕x ''轴旋转α，其变换关系为：

⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡'''''''''⨯⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡-=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡''''''z y x z y x ααααcos sin 0sin cos 00

01=[A]⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡'''''''''⨯z y x 将上述三个变换公式合并，得：

[][][]⎥⎥⎥⎦

⎤⎢⎢⎢⎣⎡'''''''''⨯⨯⨯=⎥⎥⎥⎦⎤⎢⎢⎢⎣⎡z y x A B C z y x 由上述变换过程可知，在只有旋转，没有平移的情况下，（X a1,Y a1, Z a1）等同于(x, y, z)，同为静坐标，而（x a1, y a1, z a1）等同于(x ''',y ''',z ''')，同为动坐标，所以，旋转变换矩阵[T]= [C]×[B]×[A]=

⎥⎥⎥⎦

⎤⎢⎢⎢⎣⎡-+-+++-βαβαβγβαγαγβαγαγβγβαγαγβαγαγβcos cos cos sin sin sin sin cos cos sin sin sin sin cos cos sin cos cos sin cos sin sin cos sin sin sin cos cos cos

将矩阵[T]代入前面的变换公式，即可求出a1的静坐标（X a1, Y a1, Z a1），从而可以求出油缸的长度L 1为：

2112112111)()()(A a A a A a Z Z Y Y X X L -+-+-=

同理可得：

2222222222)()()(A a A a A a Z Z Y Y X X L -+-+-=