幅相控制策略在六自由度运动模拟器中的应用
2023-09-12
来源:步旅网
第29卷第11期 2008年11月 哈尔滨工程大学学报 V01.29 No.11 NOV.2OO8 Journal of Harbin Engineering University 幅相控制策略在六自由度运动模拟器中的应用 马建明,黄其涛,丛大成,叶正茂,韩俊伟 (哈尔滨工业大学机电工程学院,黑龙江哈尔滨150001) 摘要:由于六自由度运动模拟器自身的闭环频率特性及非线性等因素,对于正弦输入信号存在幅值衰减和相位滞后, 很难实现对高频正弦信号的精确跟踪,针对这一问题采用基于Widrow—Hoff学习算法的幅相控制策略.利用运动学正解 间接得到的运动模拟器上平台位姿的反馈信号,通过该控制策略迅速地调整系统输入正弦信号的幅值和相位,使系统输 出在短时间内对设定信号进行精确跟踪.仿真和实验表明,该方法在实现六自由度运动模拟器对正弦信号的精确跟踪问 题上明显优于常规的经典控制,对于其他正弦运动的精确跟踪系统同样具有普遍意义. 关键词:六自由度运动模拟器;Widrow-Hoff学习算法;幅相控制策略;精确跟踪 中图分类号:TP242.2文献标识码:A文章编号:1006—7043(2008)11—1216-06 Application of the amplitude-phase control strategy in a 6.DOF motion simulator MA Jian—ming,HUANG Qi・tao,CONG Da—cheng,YE Zheng—mao,HAN Jun—wei (School of Mechanical and Electrical Engineering,Harbin Institute of Technology,Harbin 150001,China) Abstract:Due to closed・・loop amplitude and frequency response characteristics and nonlinear factors in 6-DOF mo・・ tion simulators,itg difficult to accurately track high frequency harmonic motion.To solve the problem,this paper proposes a control strategy based on the Widrow—Hoff learning algorithm.It adopts the feedback signals of position and orientation of the moving platform.which is indirectly achieved by solving the forward kinematics of the 6-DOF motion simulator,to quickly adjust the amplitude and phase of the input harmonic motion singals.Thus,it can en— able the output singal to accurately track the input signal in a short period of time.Simulations and experiments prove that the control strategy is obviously superior to the conventional control strategy in tracking harmonic motion of 6-DOF motion simulators.It also has universal singiifcance to other systems that must precisely track harmonic motion. Keywords:6一DOF motion simulator;Widrow—Hoff learning algorithm;amplitude—phase control strategy;accurate tracking 并联机器人由于其较串联机器人具有刚度大、 弦运动可以用来测试或校准某些直线运动和旋转运 承载能力强、精度高、易于控制等优点,近30年来成 动….正弦运动的跟踪性能指标可以用在一定频率 为机器人研究领域的热点.六自由度运动模拟器是 范围内的系统输出与输入之间的幅值误差、相位误 六自由度并联机器人的一个十分重要的应用领域, 差来表示.文中正弦运动的精确跟踪指标设定为幅 具有广泛的发展空间和良好的应用前景. 值误差不超过10%,相位误差不超过1O。.然而,液 正弦运动信号是各种六自由度运动模拟器系统 压驱动六自由度运动模拟器在各自由度方向上的固 十分常用而且非常重要的一种测试信号.精确的正 有频率一般不超过15Hz,若只采用经典的PID调节 加输入信号的前馈控制,由于其自身的闭环频率特 收藕日期:2007-09.11. 基金项目:教育部新世纪优秀人才支持计划资助项目(NCET-04— 性及非线性等因素,对于输入的正弦信号存在幅值 0325). 作者简介:马建明(1980-),男,博士研究生,E—mail:haiguox@163. 衰减和相位滞后,而且随着输入信号频率的逐渐提 COlll; 韩俊伟(1964-),男,教授,博士生导师. 高,这种现象更趋严重,因此很难实现对高频正弦信 第11期 马建明,等:幅相控制策略在六自由度运动模拟器中的应用 ・1217・ 号的精确跟踪.针对这一问题,该文提出采用基于 Widrow.Hoff学习算法的幅相控制策略,该方法能够 利用运动学正解间接得到的六自由度运动模拟器上 平台位姿的反馈信号,通过迅速地调整系统正弦输 入信号的幅值和相位,使系统的输出在短时间内对 设定信号进行精确跟踪. 1 六自由度运动模拟器系统描述 六自由度运动模拟器由上平台、基座、上铰、下 铰,以及连接于上平台和基座之间的6套阀控液压 伺服作动器构成,如图1所示.作动器与上平台和基 座之间分别用十字铰和虎克铰连接,通过6个作动 器的协调动作来实现其在空间的六自由度运动.6 套液压伺服系统均由非对称伺服阀控制的非对称液 压缸组成. 图1六自由度运动模拟器 Fig.1 6-DOF motion simulator 六自由度运动模拟器是一个典型的复杂非线性 的多输人多输出系统,随着上平台及负载在工作空 间中的位姿不同,使得6套液压伺服系统在不同位 姿下具有不同的负载特性,同时由于采用液压驱动, 整个液压系统的管路、伺服阀、液压缸在系统运行过 程中的动态特性和液压系统中存在的摩擦、死区和 间隙等非线性因素都直接影响着系统的状态参数, 使整个系统在运行过程中具有很强的时变性.常规 的PID调节加前馈控制的控制策略对于一般精度的 六自由度运动模拟器来说具有参数调节方便,易于 实现等特点,但是对于精确的正弦跟踪系统来说,却 很难取得令人满意的效果. 基于Widrow—Hoff学习算法的六自由度运动模 拟器正弦运动精确跟踪系统的原理框图如图2所 示,整个系统由正弦信号发生器、自学习校正网络、 运动学反解模块、运动学正解模块、6套液压伺服系 统和上平台及负载组成,其中最关键的部分是自学 习校正网络和运动学正解模块. 图2六自由度运动模拟器正弦运动精确跟踪系统原理框图 Fig.2 Principle block diagram of the accurate harmonic motion tracking system of the 6-DOF motion simulator 自学习校正网络的快速校正功能是由Widrow・ Hoff学习算法来实现的.Widrow—Hoff学习算法是由 美国Standford大学的Widrow和Hoff于1959年提 出的,包括一种自适应线性神经网络(ADALINE)和 最小均方算法(LMS).ADALINE是一种连续时间线 性神经元【2],以前这种算法通常主要用于复杂系统 的自适应滤波、故障检测等领域并成功应用于电力 系统和化工业等行业【3 .文献[7]将该算法用于液 压系统的同步控制中,并讨论了算法的稳定性问题, 文献[8]基于该算法设计了自适应相位纠偏器用于 液压伺服系统中,解决正弦运动的相位滞后问题,取 得了很好的效果.该文建立了基于此算法的校正网 络,将此算法应用于六自由度运动模拟器中实现对 正弦运动的精确跟踪. 2 幅相控制策略及其原理 Widrow—Hoff学习算法是建立在ADALINE神经 网络基础上的,它具有一个线性的传输函数,其结构 原理如图3所示.虚线框内是一个双输入的单层线 性神经元.对应的公式为 purelin(w s+d)=Wls1+W2s2+d.(1) 式中: 为神经网络的输出,权值向量'.,:[ 。 :] ,输入向量 =[s s ] ,d是偏移量,通常取d 为0. 在任意给定时刻ADALINE神经网络的输入一 输出成线性关系,当权值在线调整时,这种关系作为 时间t的函数是非线性的.学习的过程就是权值调 整的过程,以使输出信号能够跟踪设定的输入信号.‘ 该网络的主要优点是结构简单、能够在线调整参数 并具有快速性 J. ・1218・ 哈尔滨工程大学学报 第29卷 设正弦输入信号为:r(t):A sin(tot+咖。),此处取 等于0,即r( )=A sin(tot).将该信号往后相移 90。,则r,(f)=一A COS(tot),将r(f)和r】(t)分别作 为校正网络的输入s 和s ,并乘以W 和 :后进行 叠加作为神经网络的输出 ,然后经过运动学反解 双输人单层神经元 送给六自由度运动模拟器的液压伺服控制系统.同 时,采集液压缸位移传感器的信号,经过运动学正 解,间接得到六自由度运动模拟器上平台的实际位 图3双输入ADALINE神经网络结构原理图 姿,使该位姿也经过一个同构的神经网络,其输出为 Fig.3 ADALINE neur ̄network with two input ports O/ , 与 之差即为神经网络的输出误差,根据该 自学习校正网络构造的基本原理如图4所示. 误差,利用LMS算法调整权值向量. 图4校正网络的原理图 Fig.4 Principle block diagram of the adjustment network 根据LMS算法定义,利用最速下降法 ,可以 运动模拟器上平台当前时刻的实际位姿,校正网络 得到计算校正网络权值向量的基本公式: 必须利用该位姿对系统的输入信号进行调整,从而 w(k+1)=W(k)+2 (k)S. (2) 最终达到精确跟踪的目的.因此,运动学正解的实时 式中: 是学习系数,可以控制算法的稳定性和收敛 性及其精度是影响系统跟踪性能的关键因素之一. 速度;e(k)是k时刻的神经网络的输出误差. 采用文献[11]中的运动学正解算法.该算法采用牛 均方误差是一个中间向下凹的抛物线型曲面, 顿一拉夫森公式求解一组运动学非线性方程组,求解 在整个定义域具有最小值,通过最速下降法,可求得 精度为2×10~m,在文中描述的六自由度运动模 最佳权值向量,使得均方误差为最小.从图4中可以 拟器系统中,整个系统运行一个周期的平均时间为 看出,只要运动学正解的输出和系统的给定位姿之 1.12 ms,可以严格保证实际应用的实时性和精度要 间存在误差,经过同构的ADALINE神经网络后此 求. 误差就必然在网络输出误差e上体现出来.于是由 式(2)计算下一个时刻的权值,实时地调整W 、埘:, 3 六自由度运动模拟器正弦仿真分析 经过叠加后使神经网络的输出 Ot的幅值和相位发 根据文献[12]中采用Kane方法建立的六自由 生相应变化,由于 经过运动学反解后直接输入到 度并联机器人多刚体动力学方程和液压伺服系统的 液压伺服系统中,从而影响到系统的输出并使其朝 动力学方程搭建Matlab/Simulink模型进行仿真,液 着误差减小的趋势变化,直到误差消除,权值也最终 压伺服系统的主要参数取自实际的六自由度运动模 趋于稳定,并使输出位姿和设定的位姿信号达到一 拟器的液压伺服系统.液压缸活塞直径D:0.063 m, 致,也即实现了正弦信号的精确跟踪. 活塞杆直径d=0.045 nl,液压缸的有效行程 : 由于运动学正解的输出间接地反映了六自由度 445 mm,伺服阀7MPa下的空载流量为63IVmin,油 第11期 马建明,等:幅相控制策略在六自由度运动模拟器中的应用 源压力P =14 MPa,上平台和负载的总质量m= 300 kg. 采用经典的PID调节加输入信号的前馈控制策 略,在 向输入幅值为1 mm,频率20Hz的正弦信 号,得到的仿真曲线如图5所示. 向幅值误差为 34.7%,相位误差为79.6。.再利用应用了幅相控制 策略的模型进行仿真,在 向输入同样幅值和频率 的正弦信号,取 =10,权值向量初值 =[1.23 —1.75]T,经过几个周期的学习后,仿真曲线如图6 所示. 向幅值误差仅为1.17%,相位误差为0.00。. 1.0 0.5 吕 {0 一0.5 一1.O 0 O.05 0.10 0.15 0.20 0.25 t/s 图5采用经典控制策略的系统输入、输出 Fig.5 Input and output of system used PID control strategy 图6经过校正网络后的系统输入、输出 Fig.6 Input and output of system used adjustment network 4 六自由度运动模拟器正弦实验研究 利用该文描述的六自由度运动模拟器,以 向 为例,进行实验研究.采用经典的PID调节加输入信 号的前馈控制策略,通过系统辨识,得到系统的幅频 特性曲线如图7所示,从图中可见,系统的位置频宽 大约在9~lOHz左右. 在 向依次输入不同幅值和频率的正弦信号, 得到的幅值误差和相位误差如表1所示,相应的实 验曲线如图8所示.从表中可见当输入信号的频率 达到25Hz时,输出信号的幅值误差为63.7%,相位 误差为108.9。.幅值衰减和相位滞后非常严重,输 出信号对输入信号的跟踪已经严重失真. f/Hz 图7 向幅频特性 Fig.7 Amplitude-frequency characteristic of X direction 表1 采用经典控制策略的x向正弦运动参数及结果 Table 1 Parameters and results of harmonic motion in X direction used PID control strategy (a)信号频率5 Hz t}s (b)信号频率10 Hz (c)信号频率20 Hz ・1220・ 哈尔滨工程大学学报 第29卷 (d)信号频率25 Hz 图8采用经典控制策略的实验曲线 Fig。8 Experimental curves under the PID control strategy 将幅相控制策略应用于该六自由度运动模拟器 中,同样在 向输入不同幅值和频率的正弦信号, 同时 值、权值向量初值’.,。如表2所示,经过几个 周期的学习后,相应的幅值误差和相位误差示于表 2中,相应的实验曲线如图9所示.从表中可见当输 入信号的频率达到25Hz时,输出信号的幅值误差 仅为6.44%,相位误差仅为4.O5。输出信号仍然可 以以很高的精度跟踪输入信号. 表2采用幅相控制策略的 向正弦运动参数及结果 Table 2 Parameters and results of harmonic motion in X direction used amplitude・phase control strategy 其他5个自由度的跟踪效果与 向自由度的 跟踪效果相似,此处不再赘述.从实验曲线和跟踪精 度的分析结果可以看出,采用幅相控制策略的六自 由度运动模拟器正弦运动精确跟踪系统,可以在很 短的时间内使六自由度运动模拟器对输入的正弦信 号以很小的误差进行跟踪,即便是对于频率为系统 位置频宽2.5倍的高频正弦信号也同样有效,相比 于经典的PID调节加输入信号前馈的控制策略具有 明显的优势. 125.4 125.6 125.8 126.0 126.2 126.4 t/s (a)信号频率5 Hz 3 2 1 l 0 一1 —2 —3 l7 (b)信号频率10 Hz (C)信号频率20 Hz (d)信号频率25 Hz 图9采用幅相控制策略的实验曲线 Fig.9 Experimental CuITeS under the amplitude—phase control strategy 5 结束语 采用基于Widrow—Hoff学习算法的幅相控制策 略设计了六自由度运动模拟器正弦运动精确跟踪系 统,在对正弦位姿信号的跟踪问题上,明显优于经典 的PID调节加输入信号前馈的控制策略,而且这种 方法不需要对系统进行参数辨识,自学习过程短,参 数调整方便,易于在实际应用中实现.除了用于六自 第11期 马建明,等:幅相控制策略在六自由度运动模拟器中的应用 ・1221・ 由度运动模拟器以外,对于其他正弦运动的精确跟 踪系统同样具有普遍意义. tos[J].Chem rEng Technol,2004,27(2):130-138. [7]延皓,叶正茂,张辉,等.基于Widrow—Hoff学习算 法的液压协调加载控制策略研究[J].地震工程与工程 参考文献: [1]张元生,杨一栋,马智周,等.三轴转台谐波幅相自适 应控制系统的设计[J].南京航空航天大学学报,2004, 36(5):619-622. ZHANG Yuansheng,YANG Yidong,MA Zhizhou,et a1. 振动,2006,26(3):104-107. 、 YAN Hao,YE Zhengmao,ZHANG Hui,et a1.Hydraulic senro systems synchronous loading strategy based on Wid— row—Hoff learning rules[J].Earthquake Engineering and Engineering Vibration,2006,26(3):104—107. [8]姚建均,丛大成,姜洪洲,等.基于神经网络的自适应 Design of harmonic amplitude-phase adaptive control System in three-axis turntables[J].Journal of Nanjing University of Aeronautics and Astronautics,2004,36(5):619-622. [2]徐丽娜.神经网络控制[M].哈尔滨:哈尔滨工业大学 出版社,1999:16—18. [3]周玉光,艾芊,顾丹珍,等.自适应线性神经元在电 能质量扰动诊断和频率跟踪中的应用[J].上海交通大 学学报,2005,37(12):2072-2077,2087. ZHOU Yuguang,AI Qian,GU Danzhen,et a1.Adaline and its application in power quality disturbances detection and frequency tracking[J].Journal of Shanghai Jiao Tong Uni— versity,2005,37(12):2072—2077,2087. [4]DASH P K,SWAIN D P,ROUTRAY A,et a1.An adap— tive neural network approach for the estimation of power sys- tem frequency[J].Electirc Power Systems Research,1887, 4l(3):203—210. [5]ABDEL-GALI T K,EL—SAADANY E F,SALAM M M A. Power quality event detection using adaline[J .Electirc Power System Research,2003,64(1):137—144. f61MICHAEL M,MWEMBESHI C A。KENT S S.Flexible on. 1ine modeling and control of pH in waste neutralization reac— 相位纠偏器在电液伺服系统中的应用[J].吉林大学学 报(工学版),2007,37(4):930-934. YAO Jianjun,CONG Dacheng,JIANG Hongzhou,et a1. ANN-based adaptive phase corrector applied in electro—hy— draulic sen,0 system[J].Journal of Jilin University(Engi— neering nad Technology Edition),2007,37(4):930-934. [9]WIDROW B.Adaptive filters[M].New York: McGrawhill,1970:36-62. [10]HAGAN M T,DEMUTH H B,BEALE M H,等.神经网 络设计[M].戴葵,译.北京:机械工业出版社,2002: 168—175. [11]KOEKEBAKKER S H.Model based control ofa lfight sim— ulator motion system[D].Netherlands:Delft University of Technology,2001:33-60. [12]何景峰.液压驱动六自由度并联机器人特性及其控制 策略研究[D].哈尔滨:哈尔滨工业大学,2007:31—38. HE Jingfeng.Analysis and control of hydraulically driven 6-DOF parallel manipulator.[D].Harbin:Harbin Institute of Technology,2007:31—38. [责任编辑:郑可为]