基于Elman神经网络的Stewart平台位姿正解①

何亚林,赵新龙

(浙江理工大学 机械与自动控制学院,杭州 310018)

Stewart 微动平台由动平台、定平台和连杆通过铰链链接而成,可以实现6 自由度运动.作为一种并联机器结构,具有结构刚度大、位置精度高、载重比高等优点,被广泛应用于电子元件生产中的夹持系统、精密机床中的刀具控制和钻铣等领域.Stewart 平台具有运动空间小、鲁棒性强、惯性小、运动精度高以及成本较低等优点,同时具有较大的刚度和良好的定位能力,是串联机构所不能代替的.从Stewart 平台的控制方面看,Stewart 平台包含两个最基本的问题:位姿正解和位姿反解.位姿反解即Stewart 的运动学反解是已知求解平台的位姿,即已知3 个线性坐标X、Y、Z 和3个旋转坐标参量 α、β、γ[1],求解平台的6 个支腿长度.位姿正解即Stewart 的运动学正解则是已知平台的6 个支腿长度求解平台位姿.对Stewart 平台来说,运动学反解的求解较容易求得,而运动学正解的求解比较困难[2].位姿正解的求解对于Stewart 平台空间分析、机构设计以及机构在故障中恢复均有重要作用[3],因此,合理有效快速的位姿正解求解方法是十分必要的.然而,由于Stewart 平台具有高耦合性、非线性等特点,其位姿正解的求解问题一直是一个难题.无法进行准确的位姿正解将使系统无法准确得知目前的平台运动状态,会导致产生较大误差或引起系统震荡等问题.

目前,位姿正解的求解方法主要有数值法和解析法两种.数值法[4-7]采用迭代法进行求解,迭代法对迭代初值的要求较高,初值选择不当会导致迭代无法正常收敛,从而无法获得正确解.解析法[8-10]是通过构建多组约束方程并消去未知数的方法,该法的求解过程较复杂、消元方法不确定,同时求解过程慢,无法满足实时控制的要求.近年来,基于智能算法的位姿正解方法引起学者的关注,刘伟锐等提出采用一种改进的粒子群算法求解并联机构的位姿正解[11].张宗之等[12]采用BP 神经网络来对Stewart 平台进行位姿正解,收敛速度较慢,容易陷入局部极值.

为了改进迭代法和解析法的缺点,首先建立Stewart平台支腿长度与平台位姿的运动学模型,然后利用Elman神经网络来实现位姿正解的求解并实验验证.该方法具有良好的动态特性[13],精度高,能够快速准确的实现Stewart 平台位姿正解的求解.

1 Stewart 平台运动学模型

Stewart 平台结构如图1所示,驱动器利用万向节和平台、底座链接,通过伸缩运动驱动动平台运动,从而在三维空间中实现6 自由度的运动[14].

图1 Stewart 平台结构图

建立动坐标系Op-XpYpZp和静坐标系O-XYZ.两坐标系原点分别为动、静平台的质心,坐标平面OpXpYp与动平台重合,坐标平面OXY 与静平台重合,Zp轴和Z轴垂直OXY 平面竖直向上.

在对平台进行控制时,涉及到从任务空间至关节空间的转换,任务空间采用位姿q=进行描述,关节空间采用l=[l1l2l3l4l5l6]T进行描述.支腿i上端坐标为下端坐标为绕Z 轴的偏转角 γ,绕Y 轴的俯仰角为 β,绕X 轴的滚动角为 α,可以得到绕各轴转动的坐标变换矩阵

动平台相对于定平台的旋转矩阵为:

计算长度时,需要统一坐标系,即通过转换矩阵将动坐标系Op-XpYpZp中的坐标转换到静坐标系O-XYZ中,变换矩阵为:

式中,Sα=sinα,Cα=cosα,其他类似.xp、yp、zp表示动坐标系原点在静坐标系中的坐标.将动坐标系中的坐标转换至静坐标系后为:

根据支腿两端坐标,可得支腿长度为:

从数学模型可见,6 条支腿长度l=[l1l2l3l4l5l6]T与位姿q=[xp yp zpα β γ]T之间的关系可以用6 个结构相同的非线性方程表示:

对式(5)所示的方程组进行求解,就可以得到平台的位姿参数,即得到动平面对应的动坐标系Op-XpYpZp原点Op的坐标和动平台的欧拉角(α β γ).

由式(5)可得,Stewart 平台的模型是由6 个多元非线性方程构成,无法通过常规的公式推导进行简化和求解.在实际应用中,由于模型失配、测量误差等,所建立的非线性方程组不完全守恒,从而会造成求解失败的现象.Elman 神经网络作为一种具有局部记忆单元和局部反馈连接的递归神经网络[10],具有良好的动态特性,收敛速度快,因此,基于Elman 神经网络建立Stewart 平台的位姿正解模型.

2 基于Elman 神经网络的Stewart 平台位姿正解

Elman 神经网络的网络结构一般分为4 层:输入层、输出层(中间层)、承接层和输出层.输入层、隐含层、输出层的连接类似于前馈式网络,输入层的单元仅起信号传输作用,输出层单元起线性加权作用.隐含层单元的传递函数可采用线性或者非线性函数,承接层又称为上下文层或者状态层,它用来记忆隐含层单元前一时刻的输出值并返回给网络的输入,可以认为是一个一步延时算子.Elman 神经网络的网络结构图如图2所示.

图2 Elman 神经网络结构图

采用Elman 神经网络进行位姿正解时,输入为6 条支腿长度输出为位姿y=

数学模型可以表示为:

其中,α为增益因子,f(·)和g(·)为 激活函数,k=2,3,···,n,n为样本数.

Elman 神经网络的输出可表示为:

学习指标函数为:

神经网络的权重更新公式为:

学习指标E关于的偏导数为:

同理,学习指标E关于的偏导数为:

∂xj(k)/可由下式得到:

若不考虑xc(k),式(14)可写为:

同理,学习指标E关于的偏导数为:

其中,

3 Elman 神经网络训练与验证

图3所示为本次的实验对象Stewart 平台.

图3 Stewart 平台

3.1 Stewart 平台参数

根据表1和表2的Stewart 平台参数,圆上任意一点坐标计算公式:

其中,x′、y′分别代表任意一点在圆上的X、Y轴坐标,r′为圆半径,α′为任意一点与圆心的连线与X轴之间的角度.可得支腿各个连接点在静平台坐标系中的初始坐标如表3、表4.参数化模型如图4所示.

表1 Stewart 平台尺寸参数

表2 Stewart 平台支腿连接点位置参数(单位:°)

表3 支腿动平台连接点坐标

表4 支腿静平台连接点坐标

图4 Stewart 平台参数化模型

3.2 Elman 神经网络训练及验证

Elman 神经网络模型结构选择为6-5-6,输入为支腿长度u=输出为位姿y=隐含层使用Sigmoid 函数,输出层使用Purelin 线性传递函数,样本通过位姿反解求得.

根据表5,可选取运动函数为:

对应的6 个支腿长度变化曲线如图5所示.

最终结果如图6与图7所示,分别为X、Y、Z 和α、β、γ方向上的Elman 神经网络输出与实际输出图,图中黑色虚线代表Elman 神经网络输出,绿色点虚线代表实际输出,误差统计见表6.图8与图9分别表示X、Y、Z 和α、β、γ方向上的误差图.

表5 Stewart 平台运动范围参数

图5 样本支腿长度变化图

图7 α、β、γ 输出结果

表6 Elman 神经网络输出结果误差统计

图8 X、Y、Z 误差

4 结论

由于Stewart 平台的位姿正解方程组由6 个多元非线性方程构成,普通方法难以得位姿正解.更快更准确地求出其位姿有助于对Stewart 平台的分析.根据平台结构与其运动学模型建立了相应动平台与静平台坐标系,用以描述支腿各连接点位置坐标和平台位姿,通过坐标法表示运动位姿与支腿长度之间的关系.建立了模型基于Elman 神经网络的Stewart 平台位姿正解模型,对网络进行训练和实验验证.实验结果表明:基于elman 神经网络的Stewart 平台位姿正解方法对于Stewart 平台的位姿正解问题效果良好,位移误差和旋转角度误差范围都在10-7～10-9mm 左右,精准度高,验证了该法的有效性.

图9 α、β、γ 误差