超冗余多轴液压振动台的内力耦合控制
魏巍1,2, 杨志东2, 曲志勇2, 韩俊伟2
1.中国工程物理研究院机械制造工艺研究所,四川 绵阳 621900
2.哈尔滨工业大学 机电学院,哈尔滨 150001

作者简介:魏巍(1987-),男,博士研究生.研究方向:多轴振动台.E-mail:iamcoolweiwei@foxmail.com

摘要

针对传统多轴振动台内力耦合控制策略控制参数复杂、控制效果差的缺点,提出一种基于变形位移和变形力空间的内力耦合控制策略。给出超冗余振动台电液伺服系统的非线性方程及机械部分的单刚体动力学模型,在内力耦合空间分析的基础上,通过内力合成矩阵对合成内力进行闭环反馈补偿,由冗余变形分解矩阵将补偿量分配到各液压伺服阀的输入端。仿真结果显示该算法能有效降低超冗余液压振动台的液压缸出力及耦合内力。

关键词: 流体传动与控制; 超冗余振动台; 内力耦合; 电液伺服系统
中图分类号:TH137 文献标志码:A 文章编号:1671-5497(2015)05-1461-07
Internal force coupling control for hyper-redundant multi-axis
WEI Wei1,2, YANG Zhi-dong2, QU Zhi-yong2, HAN Jun-wei2
1.Institute of Machinery Manufacturing Technology,China Academy of Engineering Physics,Mianyang 621900,China
2.School of Mechatronic Engineering, Harbin Institute of Technology, Harbin 150001, China
Abstract

Traditional internal force coupling control for shaking table is complex and shows poor control performance because of the same control parameter numbers of the cylinders. In order to stabilize the internal force, a novel Internal Force Coupling (IFC) control strategy is proposed based on deformation displacement and force spaces. Nonlinear equations of electro-hydraulic servo system and single rigid body dynamic model of mechanical part of the hyper-redundant shaking table are established with hydraulic and parallel mechanism theory respectively. Under the analysis of internal force space, internal forces calculated by force synthesis matrix are compensated in closed loop and decomposed to the inputs of the servovalves through the redundant deformation matrix. Simulation results show that the IFC control strategy effectively reduces cylinder forces and internal coupling forces of the hyper-redundant multi-axis hydraulic shaking table.

Keyword: fluid power transmission and control; hyper-redundant shaking table; internal force coupling; electro-hydraulic servo system

超冗余多轴液压振动台主要用于大型结构件的地震及其他振动环境下的模拟试验[1]。为了获得更大的出力, 这类多轴振动台的液压缸数量往往远多于其控制的自由度数[2, 3, 4, 5]。虽然冗余驱动有良好的承载能力, 但是运动过程中各液压作动器参数和特性的不一致以及安装误差等因素会使得各个驱动器之间产生很大的内力纷争, 这种内力耦合会降低系统的性能, 减小激振系统的净出力, 严重时甚至会导致振动台根本无法动作[6, 7, 8]。而超冗余振动台由于具有更多的冗余自由度, 因此其内力耦合的现象会更为严重。

内力耦合控制是指采用特定的控制策略来消除或减弱内力耦合, 它是其他控制策略有效的基础。关广丰[9]提出压力镇定控制技术, 其控制思想为液压缸压力同步控制思想, 将液压缸间压力差别作为反馈量修正驱动信号, 以达到减弱内力耦合的目标。Underwood[10]提出八自由度思想来解决冗余振动台的自由度控制问题, 在原有六自由度动作空间基础上再引入两个扭曲自由度, 通过抑制这两个自由度的输出, 达到抑制内力耦合的目的。这些方法在一定程度上起到了抑制内力耦合的效果, 但是只适用于驱动冗余度比较小(冗余度为2)的情况, 当冗余度较大时这些内力耦合抑制方法的效果将受到限制。传统的压力镇定控制没有对内力耦合空间进行分析, 需要调整的控制参数与所需要的激振器数目相同, 不适合驱动冗余度大的振动台。本文将对超冗余振动台的内力耦合空间进行分析, 并在此基础上对内力进行补偿控制。

1 超冗余多轴液压振动台模型

本文中研究的超冗余多轴液压振动台的结构如图1所示。12个液压缸均布在xyz三个互相垂直的方向。每个液压缸通过两个球铰分别与上平台和基础相连。该超冗余多轴液压振动台的冗余度为6, 其对应的俯视图如图2所示。

图1 超冗余振动台简图Fig.1 Hyper-redundant shaking table

图2 超冗余振动台的俯视示意图Fig.2 Top view of hyper-redundant shaking table

1.1 机械系统模型

图1所示, 动坐标系{p}与上平台固连在一起, 并随着上平台一起运动, 而静坐标系{b}固连在基础上, 始终保持不变。上平台处于初始位置时, {p}与{b}的原点与上平台的质心重合。超冗余多轴振动台运动学的反解是通过给定上平台的位姿计算出液压缸的位移量, 液压缸的长度矢量为:

li=T·Ai-Bi+c1

式中:li为第i个液压缸的长度矢量; TR3× 3为动坐标系{p}到静坐标系{b}之间的旋转变换矩阵; AiR3为第i个上铰点在动坐标系{p}下的坐标; c= xyzTR3为上平台的平动位移; BiR3为第i个下铰点在静坐标系{b}下的坐标。

对式(1)求导, 可得上铰点的运动速度vai为:

vai=ω×TAi+c·2

式中:ω 为{p}相对于{b}的角速度; c·为上平台中心的平动速度。

液压缸的速度 l·i为上铰点速度vai在液压缸矢量方向的投影, 结合式(2), l·i表示为:

l·i=lTnivai=[lTniTAi×lniT]c·ω3

式中:lni为第i个液压缸的单位方向矢量。

定义上平台的广义速度 q·= c·TωTT, 考虑到振动台的12个液压缸, 式(3)可写成:

l·=JlΘq·4

式中:Θ = xyzφθψTR6为上平台相对基础的位姿, 包括平动位移和欧拉旋转角; Jl ΘR12× 6为雅可比矩阵, 该矩阵和上平台的位姿Θ 相关, Jl Θ= LTnTA×LnT, 其中, Ln= ln1ln12, A= A1A12

多刚体并联机器人的动力学方程可以通过拉格朗日法、牛顿-欧拉法及虚功原理等不同的方法求解[11]。由于多轴振动台的上平台及负载质量远大于各驱动缸的活塞杆质量, 因此在求解其动力学方程时可以按照单刚体求解, 本文采用凯恩法建立系统的单刚体动力学方程[12, 13]:

fq=MΘq··+CΘ, q·q·+GΘ5

式中:M(Θ )∈ R6× 6为上平台及负载的质量矩阵; C(Θ , q·)为离心力及科氏力系数矩阵; G(Θ )为重力项; fqR6为自由度空间的力系向量。

多轴振动台垂直方向的液压缸都有平衡缸系统, 通过平衡缸的预先加压来抵消上平台及负载重力的影响。另外, 多轴振动台一般仅在零位附近做小幅值的振动, 转角很小, 离心力及科氏力对系统的动态特性的影响可以忽略[14]。同时考虑到自由度空间的力系矢量可以由关节空间的力(即液压缸的出力)转换得到, 式(5)可以变为:

JTlΘfa=MΘq··6

式中:fa为12个液压缸出力构成的力向量。

1.2 液压系统模型

电液伺服系统由伺服阀和液压缸组成, 如图3所示[15]

图3 电液伺服系统Fig.3 Electro-hydraulic servo system

电液伺服阀的阀芯位移与给定电流之间可以用一个二阶传递函数表示[16]:

x··v+2ζvωvx·v+ωv2xv=kvωv2u7

式中:xv为伺服阀阀芯位移; ω vζ v分别为伺服阀的固有频率和阻尼比; u为输入电流信号; kv为阀芯位移与电流信号之间的比例系数。

按照零开口四通滑阀建立伺服阀的流量方程, 流入液压缸左腔的流量q1和右腔的流量q2分别为:

q1=cdwxv2ρps-p1, xv0cdwxv2ρp1-pr, xv< 08q2=cdwxv2ρp2-pr, xv0cdwxv2ρps-p2, xv< 09

式中:cd为流量系数; w为伺服阀节流窗口的面积梯度; p1p2分别为液压缸左腔压力与右腔压力; pspr分别为供油压力与回油压力; ρ 为液压油密度。

图3中所示的液压缸为双作用对称液压缸, 其左腔与右腔的流量连续性方程分别为:

q1=Al·+v1βep·1+ctcp1-p210q2=Al·-v2βep·2+ctcp1-p211

式中:A为液压缸有效作用面积; l为液压缸的伸长量; β e为液压弹性模量; ctc为液压缸的总泄漏系数; v1v2分别为左腔与右腔的容积, 表示为:

v1=v+Al12v2=v-Al13

式中:v为液压缸处于中位时腔室的容积。

液压缸的输出力fa为:

fa=Ap1-p2-Bcl·14

式中:Bc为液压缸的黏性摩擦因数。

2 内力耦合空间分析
2.1 位移变换分析

对于冗余的多轴振动台, 系统的给定信号一般为负载在自由度空间的位姿信号Θ , 包括平动位移和转动位移。除了这部分自由度位移外, 冗余自由度上的位移λ 则体现在上平台的柔性变形上, 这部分的变形是由系统的内力造成的。对于小位移的运动, 由上平台的位移(包括刚体自由度位移及变形位移)到液压缸的位移可以由下面的线性公式表示[6]:

+=l15

式中:λ = λ1λ2λ6TR6为变形位移; CR12× 6DR12× 6分别为刚体位移与变形位移到液压缸位移的变化矩阵, 对于零位附近的小位移运动, 由式(4)可以得到:

C=JlΘ016

式中:Θ 0= 000000T为零位时上平台的刚性位移。

选择SR6× 12为液压缸位移到上平台刚性位移之间的变换矩阵, 则对于任意λ [5]:

Θ=Sl17

式(17)对于任意λ 均成立, 将式(17)及λ =0代入式(15)则有:

CS=I1218

式中:I12R12× 12为单位方阵。

由于变换矩阵C不是方阵, 因此, 式(18)中S的解不唯一。本文选择C的最小二乘伪逆作为S的解:

S=CTC-1CT19

将式(15)左乘S, 结合式(19), 并考虑到一般情况下λ ≠ 0可以得到:

SD=0(20)

式(20)表明DS矩阵零空间的基底组成, 矩阵D不唯一。本文采用Matlab的命令函数null(S), 通过奇异值分解的方法, 以S矩阵零空间的单位正交基底作为D的解。

2.2 力变换分析

根据能量守恒原理, 液压缸驱动力所做的功等于上平台刚体自由度空间力做的功与冗余自由度空间内力所做的功之和, 即:

fTqΘ+fTλλ=fTal21

式中:fλ = fλ1fλ2fλ6TR6为冗余内力组成的向量。

定义矩阵PR6× 12为液压缸位移到变形位移的转换矩阵, 将式(17)及P代入式(21), 得到:

STfq+PTfλ=fa22

定义矩阵QR6× 12为液压缸出力到内力的转换矩阵, 则对任意fq[5]:

fλ=Qfa23

式(23)对于任意fq均成立, 将式(23)及fq=0代入式(22)则有:

PTQ=I1224

将式(22)左乘Q, 结合式(23)得到:

QST=0SQT=0(25)

与式(20)比较可得:

Q=DT26

矩阵Q即为液压缸出力到冗余内力的变换矩阵。

3 内力耦合控制策略

由第2节得到内力变换矩阵, 引入控制量U:

U=-D·diagkf1, kf2, , kf6·QPL27

由于矩阵DQ均为正交向量组成, 内力空间的基底互相垂直, 且均为单位长度。各液压缸的出力通过该矩阵合成的冗余内力为同一个度量空间。因此, kf1=kf2==kf6。式(27)变为:

U=-kf·DQPL28

12个液压作动器在上平台的布置方式如图2所示, 其中1号与4号液压缸之间的距离为1 m; 2号与3号液压缸之间的距离为0.5 m; 5号与8号液压缸之间的距离为1 m; 6号与7号液压缸之间的距离为0.5 m; 9号与10号液压缸之间的距离为1 m。由此得到内力耦合控制策略中的各变换矩阵分别如下。

自由度分解矩阵C为:

C= 10000-0.510000-0.25100000.25100000.501000-0.501000-0.25010000.25010000.500-10.50.5000-1-0.50.5000-1-0.5-0.5000-10.5-0.50

自由度合成矩阵S为:

ST=

0.250000-0.40.250000-0.20.2500000.20.2500000.400.25000-0.400.25000-0.200.250000.200.250000.400-0.250.50.5000-0.25-0.50.5000-0.25-0.5-0.5000-0.250.5-0.50

冗余位移分解矩阵D为:

D=

0.40.53-0.07-0.22-0.21-0.06-0.46-0.50.19-0.07-0.42-0.160.530.030.450.210.340.580.003-0.07-0.570.080.29-0.36-0.21-0.17-0.35-0.260.420.32-0.040.150.20.70.1-0.390.65-0.440.08-0.15-0.240.002-0.40.470.07-0.28-0.290.06000.25-0.250.25-0.2500-0.250.25-0.250.25000.25-0.250.25-0.2500-0.250.25-0.250.25

内力变换矩阵Q为:Q=DT

多轴振动台的控制一般采用的是自由度零位线性化控制[7], 液压缸的位移经过自由度合成矩阵变换为位姿反馈信号参与自由度闭环, 自由度控制信号则经过自由度分解矩阵变换为电液伺服系统的伺服阀输入信号。将内力耦合控制策略加入自由度零位线性化控制结构中, 可以得到图4所示的超冗余振动台的整体控制框图。液压缸的压力信号经内力变换矩阵转为冗余内力参与内力闭环控制, 内力控制信号经过冗余位移分解矩阵变为伺服阀输入信号, 将其与自由度零位线性化控制策略得到的伺服阀输入信号进行合成, 实现冗余内力的解耦控制。

图4 超冗余振动台的整体控制策略Fig.4 Overall control system of hyper-redundant shaking table

4 仿真分析

在Simulink下, 根据液压系统模型和机械系统模型建立超冗余多轴振动台的仿真模型, 并搭建图4所示的振动台整体控制策略。由于本文超冗余振动台的频宽为40 Hz, 因此选择1 ms的定步长为模型及控制算法的仿真周期, 仿真采用Runge-Kutta解算器。仿真模型中的参数如下:上平台及负载质量为1000 kg; 伺服阀固有频率为628 rad/s; 伺服阀阻尼比为0.5; 液压缸黏性阻尼系数为10000 N/(m· s-1); 液压缸有效作用面积为18.849 cm2; 供油压力为1.8× 107 Pa; 油液弹性模量为6.9× 108 Pa; 油液密度为845 kg/m3; 流量系数为0.64; 液压缸总泄漏系数为4× 10-12 m3· s-1· Pa-1

x方向给定幅值5 mm, 频率5 Hz的正弦信号进行仿真分析。当各个液压缸参数相同时, x方向四组液压缸的出力及合成的内力如图5所示。x向各缸的出力相同, 内力空间合成的内力很小, 这时的内力是由于系统零位线性化控制误差造成的。

x方向的4个液压伺服系统分别设置不同的增益(k1=1.02、k2=0.98、k3=0.99、k4=1.01)来模拟液压缸在工作过程中的不一致。不采用内力耦合控制策略时, x向各液压缸的出力及合成的内力如图6所示。与图5对比可知, 各液压缸之间动作的不一致使得超冗余振动台产生了内力, 在同一给定位移下, 液压缸需要更大的出力来平衡内力的作用, 液压缸的最大出力由1100 N提高到了2000 N, 增大了近一倍。

图5 相同参数下液压缸出力及合成内力Fig.5 Cylinder and internal forces under same parameters

图6 不同参数下液压缸出力及合成内力Fig.6 Cylinder and internal forces under different parameters

图7 内力耦合控制下液压缸出力及合成内力Fig.7 Cylinder and internal forces under IFC control

采用本文提出的内力耦合控制策略时, x方向各液压缸出力及合成的内力如图7所示。对比图6图7可以看出:采用了内力耦合控制策略后, 内力矩阵合成的内力有了显著的减低, 最大内力降到了未采用耦合控制策略时的10%以下, x方向各液压作动器的出力也趋于一致, 并且降低到各缸参数一致时的出力大小。

5 结束语

提出了一种改进的内力耦合控制策略, 用来降低超冗余液压振动台在运动过程中由于液压作动器参数不一致导致的内力耦合现象。通过对上平台自由度空间和冗余度空间的分析, 得到了内力耦合空间的正交基底, 并在此基础上给出了只有一个控制参数的内力补偿控制策略, 与传统的压力镇定方式相比, 该控制策略显著简化了参数调整过程, 更容易实现内力耦合的最优控制。基于液压系统非线性和机械系统动力学模型的仿真试验也表明, 采用该内力耦合控制策略可以有效减小系统的内力, 增大系统的净出力, 提高超冗余振动台的运动能力。

The authors have declared that no competing interests exist.

参考文献
[1] 袁立鹏, 崔淑梅, 卢红影, . 基于定理反馈理论迭代学习的液压角振动台控制策略[J]. 吉林大学学报: 工学版, 2011, 41(3): 676-682.
Yuan Li-peng, Cui Shu-mei, Lu Hong-ying, et al. QFT iteration-learning based control strategy of hydraulic angular vibration table[J]. Journal of Jilin University(Engineering and Technology Edition), 2011, 41(3): 676-682. [本文引用:1]
[2] Shen Gang, Zhu Zhen-cai, Zhang Lei, et al. Adaptive feed-forward compensation for hybrid control with acceleration time waveform replication on electro-hydraulic shaking table[J]. Control Engineering Practice, 2013, 21(8): 1128-1142. [本文引用:1]
[3] Severn R T. The development of shaking tables—A historical note[J]. Earthquake Engineering and Structural Dynamics, 2011, 40(2): 195-213. [本文引用:1]
[4] Plummer A R. A detailed dynamic model of a six-axis shaking table[J]. Journal of Earthquake Engineering, 2008, 12(4): 631-662. [本文引用:1]
[5] Tagawa Y, Kajiwara K. Controller development for the E-Defense shaking table[J]. Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, 2007, 221(2): 171-181. [本文引用:3]
[6] Plummer A R. A general coordinate transformation framework for multi-axis motion control with applications in the testing industry[J]. Control Engineering Parctice, 2010, 18(6): 598-607. [本文引用:2]
[7] Saglia J A, Tsagarakis N G, Dai J S, et al. Inverse-kinematics-based control of a redundantly actuated platform for rehabilitation[J]. Proceedings of the Institution of Mechanical Engineers, Part I: Journal of Systems and Control Engineering, 2009, 223(1): 53-70. [本文引用:2]
[8] 何景峰, 李保平, 佟志忠, . 液压驱动冗余振动台自由度控制及内力协调[J]. 振动与冲击, 2011, 30(3): 74-78.
He Jing-feng, Li Bao-ping, Tong Zhi-zhong, et al. DoF control and inner force balancing of hydraulically redundant actuated shaking table[J]. Journal of Vibration and Shock, 2011, 30(3): 74-78. [本文引用:1]
[9] 关广丰, 熊伟, 王海涛, . 6自由度电液振动台控制策略研究[J]. 振动与冲击, 2010, 29(4): 200-203.
Guan Guang-feng, Xiong Wei, Wang Hai-tao, et al. Control strategy of a 6-DOF hydraulic shaker[J]. Journal of Vibration and Shock, 2010, 29(4): 200-203. [本文引用:1]
[10] Underwood Marcos A, Keller Tony. Applying coordinate transformations to multi-DOF shaker control[J]. Sound and Vibration, 2006, 40(1): 22-27. [本文引用:1]
[11] Jiang Hong-zhou, He Jing-feng, Tong Zhi-zhong. Characteristics analysis of joint space inverse mass matrix for the optimal design of a 6-DOF parallel manipulator[J]. Mechanism and Machine Theory, 2010, 45(5): 722-739. [本文引用:1]
[12] Chen Yi-xin, Mclnroy John E. Decoupled control of flexure-jointed hexapods using estimated joint-space mass-inertia matrix[J]. IEEE Transactions on Control Systems Technology, 2004, 12(3): 413-421. [本文引用:1]
[13] Dasgupta B, Mruthyunjaya T S. Closed-form dynamic equation of the general Stewart platform through the Newton-Euler approach[J]. Mechanism and Machine Theory, 1998, 33(7): 993-1012. [本文引用:]
[14] Jiang Hong-zhou, He Jing-feng, Tong Zhi-zhong. Modal space control for a hydraulically driven Stewart platform[J]. Journal of Control Engineering and Technology, 2012, 2(3): 106-115. [本文引用:1]
[15] Merritt H E. Hydraulic Control Systems[M]. New York: John Wiley & Sons, 1967. [本文引用:1]
[16] Li H R. Hydraulic Control Systems[M]. Beijing: National Defense Industry Press, 1990. [本文引用:1]