基于内张力补偿的并联柔索机构控制系统的研究

并联柔索机构作为-种新型的并联运动机构，具有结构简单、惯性孝平动空间大和运动速度快等优点。从2O世纪9O年代初至今，美国、日本、德国、意大利、加拿大、南朝鲜和法国等国的研究人员纷纷开展这方面的研究工作，并取得了-批瞩目的研究成果。特别是法国国家航空局支持的 SACSO项目关于并联柔索机构应用于飞行器风洞试验的研究，为风洞飞行器的模型支撑技术提供了-个崭新的方法l1。虽然并联柔索机构目前还未大量投入实际应用，但从已经获得的研究成果可以预测到，这种机构在飞行器风洞试验中具有诱人的应用前景 。

六自由度并联柔索机构应用于飞行器模型风洞试验具有以下优点：(1)传统的风洞要靠特殊支架来改变模型的状态，对原系统稍加改造便可采用控柔气流场干扰较大，而采用柔索则可将此影响降低到最低程度；(2)在风洞条件许可的情况下，模型可尽量做大-些，因为与传统的支架相比，柔索对其姿态的控制要容易得多；(3)传统的风洞不容易对飞行器的姿态角处于耦合状态时(如既有 rol，又有 pitch和yaw)的-些动力学参数进行了分析，而采用并联柔索机构就方便多了。

根据作业任务的不同，机器人的运动控制通常有两种方式：- 种是调节器方式 ，用于实现点到点的位置控制；另-种是轨迹跟踪控制[31。调节器是-种比较简单的控制器，在硬件上也比较容易实现，因此借助其对冗余并联柔索机构控制系统的分析与设计来研究该模型的挣陆。对于柔性机器人，虽然采用常值重力补偿调节器，可以实现系统渐进稳定并能收敛到期望点 ，但是条件是很苛刻的，如果采用变值重力补偿，相当于引入了变值扰动，可能引起系统不稳定，尽管存在唯-的平衡点，但是却无法判断系统是否能渐进稳定地收敛到该点 。因此提出采用常值重力及内张力补偿设计冗余并联柔索机构控制系统的调节器。

来稿日期：2012-03-11基金项目：安徽省高校优秀青年人才基金项目(2011SQRL042)作者简介：汪选要，(1980)，男，安徽，硕士，讲师，主要研究方向并联机器人186 汪选要等：基于内张力补偿的并联柔索机构控制系统的研究 第1期2飞行器风洞试验动力学模型动系B-xyz位于飞行器上，柔索在动系连接点为bk(x ，，Z 1，2，3，4。柔索在定系AO-XYZ位于风洞壁上，柔索在定系连接点为 吩( f，yf，zj)jl，2，A，6。B相对于A的位姿为[ ，y，z； ，0，西] ，柔索长度：z l J ( ) 1，2，A，7 (1)式(1)即为CRPM运动学反解的显示表达式同。

图 1 CRPM结构平台图Fig.1 The Configuration Platform of CRPMZaJ国 - // 0 刁嚣 < l嘞图 2 YOZ平 面的投影图Fig.2 The Projection of YOZ Plane若以Fe R 表示动平台产生的作用力矢量 ，7根柔索的力旋量之和应等于动平台上作用的六维力矢，因此可写出动平台的静力平衡方程：1$l 2$2A $7n ∈M (2)式中：rr第 i根柔索受到的拉力；$r第 i柔索的单位线矢量，式(2)表示的螺旋方程很容易改写成矩阵形式的平衡方程：I P IlG： (3)式中： ， ， ； ， ， r r：A r，)I[G：]--阶静力影响系数矩阵也即该冗余并联柔索机构雅各比矩阵-， 。

要满足矢量封闭原理就意味着每根柔索的张力都为正值，且能产生任意的对外作用力。因此，在已知F的情况下，可以求得柔索的张力 ：rFIl-f j 1k 4式中：(·)-寸舌号中矩阵的 Moore-Penmse广义逆。

式(4)右边第-项为产生的对外作用力，第二项为柔索之间相互作用的内张力，改变矢量的值可以改变内张力的大小，进而改变柔索的张力。

系统的动力学方程，并将其写成矩阵形式D(X)Xh(X，X)G f (5)式中：D( )-动平台惯性矩阵； 乍线性哥氏力和离心力矢量；G-重力矢量； 由外力产生的等效负载；r-柔索的张力矢量。

驱动单元包括电机、减速机及柔索的绞盘，其动力学模型为线性解耦的方程：A 曰 - u (6)式中： -电机的转角位置矢量，取柔索长度增加的方向为正；A-折合到电机转子轴上的转动惯量； 合到电机转子轴上的阻尼系数； -绞盘半径； 速机的速比； -电机的输入转矩矢量。

3控制系统分析与设计如果认为柔索是线弹性的，且不计其质量，可以将柔索简化为刚度为常值的弹簧。在此基础上，柔索的张力矢量可表示为：TKw [1(q)-l(qo)- (7)式中：2(g)[z (q)A/7(q) -位置q处的柔索长度矢量；z(go)-其在初始位置 q。处的长度矢量 ；2 (g)-可 由式(1)计算 ；K。 -柔索的刚度矩阵。

图·3模型 PD反馈调节器Fig.3 Th e PD Feedback Controller图中：g厂期望柔索长度； 厂-相应的电机转角期望位置，取电机转角位置与速度为控制规律。

u e -rw(Gc ) (8)式中： ，如-正定对角反馈增益矩阵；e - ， -妒-电机转角位置误差和速度误差；G -重力补偿项。

4仿真分析已知参数如下：如图2所示，动、定平台的构型为等边三角形，动平台的质量为 100kg，绕 轴和Y轴的转动质量为 1482.6Nmz绕 轴的转动愤量为 2967Nm2，取风洞半径R0.5m，夹角 -30。。驱动单元(包括电机、减速器和绞盘)的转动惯量(折合到电机轴)为380Nmz，阻尼系数(折合到电机轴)为O.05，柔索的刚度是柔索长度的函数，由钢丝绳的破断拉力，根据经验公式计算IS]。采用电机转角位置反馈 PD控制 ，反馈增益取为 K -diag0.2，K。-diag0.07时，误差曲线，如图4所示。分析变值重力和内张力补偿可以得出，PD反郎以实现系统的稳定，但系统的稳定性撒于系统的反馈增益的取值，同时也说明了冗余并联柔索机构系统的耦合性和非线性。

No.1Jan.201 3 机械设计与制造 18710o0- 5O- 1000 1 2 3 4 51o00- 50- l00(d)I .I1.JIL.且 ～1 0 1l1l1F下 -O 1 2 3 4 5(e)巳争 已争.呈争 暑争 昌91o0500- 50- 1oo暑0 1 2 3 4 5t，s(g)图4电机转角反馈补偿 PD调节器的误差曲线Fig.4 The Error Cunre of PD Regulator Based on MotorAn e Feedback Compensation