发明名称 六维力高频疲劳试验机及使用方法
摘要 本发明一种六维力高频疲劳试验机,它包括6-UPS并联机构和控制系统两个部分,所述6-UPS并联机构由加载平台、拉压力传感器、筒式直线电机、虎克铰链、静平台及球铰链组成;该控制系统由系统硬件、系统控制方法及软件两部分组成。该六维力高频疲劳试验机以动载荷机械零件的疲劳试样为测试对象的六维力高频疲劳试验机及使用方法,可用于模拟动载荷机械零件的实际受力情况,测定其在静载荷、动载荷及交变疲劳试验中的变形情况,以解决现有疲劳试验机不能施加高频多维力的不足,以接近于实际工作状态下的受力状况,准确的测定试件的疲劳承载能力。
申请公布号 CN102279101A 申请公布日期 2011.12.14
申请号 CN201110195523.2 申请日期 2011.07.13
申请人 北京航空航天大学 发明人 陈五一;孙永生;樊锐
分类号 G01M13/00(2006.01)I 主分类号 G01M13/00(2006.01)I
代理机构 北京慧泉知识产权代理有限公司 11232 代理人 王顺荣;唐爱华
主权项 1.一种六维力高频疲劳试验机,它包括6-UPS并联机构和控制系统两个部分,其特征在于:6-UPS并联机构:该6-UPS并联机构由加载平台、拉压力传感器、筒式直线电机、虎克铰链、静平台及球铰链组成;所述加载平台,即6-UPS并联机构的动平台,由六个球铰链支撑;加载平台在安装夹具后对动载荷机械零件件进行加载;所述球铰链、拉压力传感器、筒式直线电机及虎克铰链组成加载支链;通过筒式直线电机的伸缩运动来完成加载支链的长度变化,通过筒式直线电机与球铰链和虎克铰链共同作用下改变加载平台的位姿和加载力的大小;所述筒式直线电机作为该六维力高频疲劳试验机的驱动部件,也是移动副;所述静平台作为所述6-UPS并联机构的基座,通过虎克铰链与加载支链;所述静平台和加载平台以6个加载支链相联,每个加载支链两端分别是球铰链和虎克铰链,中间是该筒式直线电机;该筒式直线电机在驱动器作用下作相对移动,改变加载支链的长度,使加载平台的位置和姿态发生变化;所述六维力高频疲劳试验机使用高性能筒式直线电机作为移动副,使6-UPS并联机构实现位置变化及加载运动;通过6个加载支链的运动组合使得加载平台产生六自由度的加载运动,对被测试样施加六维载荷;6个加载支链的运动由计算机控制,根据所需要载荷谱产生给定的运动组合及其变化规律;控制系统:该控制系统由系统硬件、系统控制方法及软件两部分组成;(1).系统硬件该系统硬件包括工控机、运动控制卡、筒式直线电机及拉压力传感器;该工控机和运动控制卡组成该六维力高频疲劳试验机控制部分,筒式直线电机和拉压力传感器安装在6-UPS并联机构上;控制系统的核心为运动控制卡,工业控制计算机负责信息流和数据流的管理,以及从传感器、编码器读取力和位置数据,并经过计算后发送控制指令;驱动器负责直线电机的功率驱动,实现位置、速度和力的控制;(2).系统控制方法及软件系统控制方法及软件由系统控制、反馈系统控制及系统软件三部分组成;a.系统控制该六维力高频疲劳试验机的控制使用力伺服控制;该力伺服控制通过模糊PID控制器来实现;模糊PID控制器对各个加载支链的驱动力进行实时跟踪,从而实现对6-UPS并联机构的力伺服控制;具体地说,首先基于6-UPS并联机构各加载支链的动力学方程建立其控制模型,然后采用模糊PID控制器对加载支链驱动力进行跟踪,从而保证6-UPS并联机构在整个运动过程中具有稳定而准确的驱动力输出;要进行力伺服控制,先要进行6-UPS并联机构的受力分析;在静力分析时,应用螺旋理论建立起6-UPS并联机构的静力平衡方程,并转化为用影响系数表示的矩阵方程;对于该试验机,机构的位形是一定的,六根杆长l<sub>1</sub>、l<sub>2</sub>、l<sub>3</sub>、l<sub>4</sub>、l<sub>5</sub>、l<sub>6</sub>是确定的,它的动平台经由6个加载支链与静平台相连,每杆两端分别为球铰链和虎克铰链,此6-UPS并联机构为稳定结构,6个加载支链上沿着加载支链的方向产生6个力,在动平台上合成为一个六维力矢;当以力旋量表示6个力时,考虑动平台的平衡,6个杆的力螺旋之和应与平台的六维力相平衡,因此列出螺旋方程;f<sub>1</sub>$<sub>1</sub>+f<sub>2</sub>$<sub>2</sub>+…+f<sub>i</sub>$<sub>i</sub>+…=F+∈M    (1)其中,i=1、2、3、4、5或6;式中,f<sub>i</sub>为第i个杆受到的轴力;$<sub>i</sub>为第i杆轴线对固定坐标系的单位线矢,$<sub>i</sub>=S<sub>i</sub>+∈S<sub>0i</sub>,S<sub>i</sub>·S<sub>i</sub>=1,S<sub>i</sub>·S<sub>0i</sub>=0;F及M分别为平台上作用力的主矢和对坐标原点主矩;上述螺旋方程写为矩阵形式的平衡方程:<maths num="0001"><![CDATA[<math><mrow><mi>F</mi><mo>=</mo><mo>[</mo><msubsup><mi>G</mi><mi>f</mi><mi>F</mi></msubsup><mo>]</mo><mi>f</mi></mrow></math>]]></maths>其中F={F<sub>x</sub>,F<sub>y</sub>,F<sub>z</sub>,M<sub>x</sub>,M<sub>y</sub>,M<sub>z</sub>}<sup>T</sup>;F<sub>x</sub>,F<sub>y</sub>,F<sub>z</sub>,M<sub>x</sub>,M<sub>y</sub>,M<sub>z</sub>分别为沿着轴x,y,z三个方向的力和扭矩;f={f<sub>1</sub>,f<sub>2</sub>…f<sub>6</sub>}<sup>T</sup>;<img file="FDA0000075468040000022.GIF" wi="95" he="62" />为静力影响系数矩阵;<maths num="0002"><![CDATA[<math><mrow><mo>[</mo><msubsup><mi>G</mi><mi>f</mi><mi>F</mi></msubsup><mo>]</mo><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>S</mi><mn>1</mn></msub></mtd><mtd><msub><mi>S</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>S</mi><mn>6</mn></msub></mtd></mtr><mtr><mtd><msub><mi>S</mi><mn>01</mn></msub></mtd><mtd><msub><mi>S</mi><mn>02</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>S</mi><mn>06</mn></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths>若动平台6个球铰链分别记为b<sub>1</sub>,b<sub>2</sub>…b<sub>6</sub>,它们对O-XYZ坐标系的空间位置以矢量b<sub>1</sub>,b<sub>2</sub>…b<sub>6</sub>表示,静平台的6个虎克铰链以B<sub>1</sub>,B<sub>2</sub>……B<sub>6</sub>表示,而对O-XYZ坐标系的位置,以矢量B<sub>1</sub>,B<sub>2</sub>,…,B<sub>6</sub>表示,则:<maths num="0003"><![CDATA[<math><mrow><msub><mi>S</mi><mi>i</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>b</mi><mi>i</mi></msub><mo>-</mo><msub><mi>B</mi><mi>i</mi></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mi>i</mi></msub><mo>-</mo><msub><mi>B</mi><mi>i</mi></msub><mo>|</mo></mrow></mfrac><mo>;</mo></mrow></math>]]></maths><maths num="0004"><![CDATA[<math><mrow><msub><mi>S</mi><mrow><mn>0</mn><mi>i</mi></mrow></msub><mo>=</mo><msub><mi>B</mi><mi>i</mi></msub><mo>&times;</mo><msub><mi>S</mi><mi>i</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>B</mi><mi>i</mi></msub><mo>&times;</mo><msub><mi>b</mi><mi>i</mi></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mi>i</mi></msub><mo>-</mo><msub><mi>B</mi><mi>i</mi></msub><mo>|</mo></mrow></mfrac></mrow></math>]]></maths>其中,i=1、2、3、4、5或6;则影响系数矩阵为<maths num="0005"><![CDATA[<math><mrow><mo>[</mo><msubsup><mi>G</mi><mi>f</mi><mi>F</mi></msubsup><mo>]</mo><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mfrac><mrow><msub><mi>b</mi><mn>1</mn></msub><mo>-</mo><msub><mi>B</mi><mn>1</mn></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mn>1</mn></msub><mo>-</mo><msub><mi>B</mi><mn>1</mn></msub><mo>|</mo></mrow></mfrac></mtd><mtd><mfrac><mrow><msub><mi>b</mi><mn>2</mn></msub><mo>-</mo><msub><mi>B</mi><mn>2</mn></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mn>2</mn></msub><mo>-</mo><msub><mi>B</mi><mn>2</mn></msub><mo>|</mo></mrow></mfrac></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><mfrac><mrow><msub><mi>b</mi><mn>6</mn></msub><mo>-</mo><msub><mi>B</mi><mn>6</mn></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mn>6</mn></msub><mo>-</mo><msub><mi>B</mi><mn>6</mn></msub><mo>|</mo></mrow></mfrac></mtd></mtr><mtr><mtd><mfrac><mrow><msub><mi>B</mi><mn>1</mn></msub><mo>&times;</mo><msub><mi>b</mi><mn>1</mn></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mn>1</mn></msub><mo>-</mo><msub><mi>B</mi><mn>1</mn></msub><mo>|</mo></mrow></mfrac></mtd><mtd><mfrac><mrow><msub><mi>B</mi><mn>2</mn></msub><mo>&times;</mo><msub><mi>b</mi><mn>2</mn></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mn>2</mn></msub><mo>-</mo><msub><mi>B</mi><mn>2</mn></msub><mo>|</mo></mrow></mfrac></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><mfrac><mrow><msub><mi>B</mi><mn>6</mn></msub><mo>&times;</mo><msub><mi>b</mi><mn>6</mn></msub></mrow><mrow><mo>|</mo><msub><mi>b</mi><mn>6</mn></msub><mo>-</mo><msub><mi>B</mi><mn>6</mn></msub><mo>|</mo></mrow></mfrac></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>根据6-UPS并联机构影响系数矩阵可知,力雅克比矩阵是满秩矩阵,所以当动平台上产生合力及合力矩已知,在各加载支链的位置、速度及加速度即已经确定并且唯一;由牛顿-欧拉法得到加载支链的动力学方程为<maths num="0006"><![CDATA[<math><mrow><msub><mi>&tau;</mi><mi>ri</mi></msub><mo>=</mo><msub><mi>m</mi><mi>ru</mi></msub><msub><mover><mi>l</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>ri</mi></msub><mo>+</mo><mfrac><mn>3</mn><mn>4</mn></mfrac><msub><mi>m</mi><mi>ru</mi></msub><msub><mi>l</mi><mi>ri</mi></msub><msubsup><mover><mi>&alpha;</mi><mo>&CenterDot;</mo></mover><mi>i</mi><mn>2</mn></msubsup><mo>+</mo><msub><mi>m</mi><mi>ru</mi></msub><mi>g</mi><mi>sin</mi><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>+</mo><mi>F</mi><mo>&CenterDot;</mo><msub><mi>l</mi><mi>ri</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,i=1、2、3、4、5或6;式中,τ<sub>ri</sub>为加载支链要求驱动力;m<sub>rui</sub>为加载支链前段质量;<img file="FDA0000075468040000035.GIF" wi="31" he="57" />为加载支链上端构件沿自身矢量方向上的移动加速度;l<sub>ri</sub>为第i个加载支链的长度;α<sub>i</sub>为第i个加载支链与动平台平面的夹角,由几何关系可知,<img file="FDA0000075468040000036.GIF" wi="456" he="140" />g为单位重力矢;F<sub>i</sub>为第i个球铰链所受外载荷力;l<sub>ri</sub>为第i个加载支链矢量;根据拉格朗日法将上式写成如下形式:<maths num="0007"><![CDATA[<math><mrow><msub><mi>&tau;</mi><mi>ri</mi></msub><mo>=</mo><msub><mi>H</mi><mi>ri</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>i</mi></msub><mo>+</mo><msub><mi>C</mi><mi>ri</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>,</mo><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>)</mo></mrow><msub><mover><mi>q</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msub><mi>G</mi><mi>ri</mi></msub><mrow><mo>(</mo><msub><mi>q</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,i=1、2、3、4、5或6;式中,H<sub>r1</sub>(q<sub>i</sub>)为第i个加载支链的惯性矩阵;<img file="FDA0000075468040000038.GIF" wi="196" he="62" />为第i个加载支链阻尼项系数矩阵;G<sub>ri</sub>(q<sub>i</sub>)为第i个加载支链重力和动平台外载荷力相关的矩阵;<img file="FDA0000075468040000039.GIF" wi="32" he="48" />为第i个的末端加速度向量;<img file="FDA00000754680400000310.GIF" wi="33" he="48" />为速度向量;q<sub>i</sub>为机构的末端位姿;以上建立了6-UPS并联机构各个加载支链的控制模型,但该6-UPS并联机构在高频加载过程中,其控制模型参数随时间变化,因此需采用模糊PID控制器对6-UPS并联机构进行控制;以误差e和误差变化<img file="FDA0000075468040000041.GIF" wi="22" he="37" />作为输入,满足不同时刻对e和<img file="FDA0000075468040000042.GIF" wi="22" he="37" />对控制参数自整定的要求;根据模糊控制理论对控制参数实行在线修改,使得被控对象品质指标始终保持在最佳范围之内;设模糊PID控制器的输入输出集合为<maths num="0008"><![CDATA[<math><mrow><mi>R</mi><mo>=</mo><mo>{</mo><mrow><mo>(</mo><mi>e</mi><mo>,</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>,</mo><mi>u</mi><mo>)</mo></mrow><mo>|</mo><mrow><mo>(</mo><mi>e</mi><mo>,</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>,</mo><mi>u</mi><mo>)</mo></mrow><mo>&Element;</mo><mo>{</mo><mi>NB</mi><mo>,</mo><mi>NM</mi><mo>,</mo><mi>NS</mi><mo>,</mo><mi>ZO</mi><mo>,</mo><mi>PS</mi><mo>,</mo><mi>PM</mi><mo>,</mo><mi>PB</mi><mo>}</mo><mo>}</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>6</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中,NB表示数值为负大,NM为负中,NS为负小,ZO为零,PS为正小,PM为正中,PB为正大,u(u∈R)为模糊PID控制器输出;设i∈I为误差e的个数,将式中各数值分别量化,则对于e∈[e<sub>i</sub>,e<sub>i+1</sub>],有<maths num="0009"><![CDATA[<math><mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>A</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>e</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mi>e</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><mi>e</mi></mrow><mrow><msub><mi>e</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>e</mi><mi>i</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>A</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mrow><mo>(</mo><mi>e</mi><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mi>e</mi><mo>-</mo><msub><mi>e</mi><mi>i</mi></msub></mrow><mrow><msub><mi>e</mi><mrow><mi>i</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>e</mi><mi>i</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>A</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>e</mi><mo>)</mo></mrow><mo>=</mo><mn>0</mn><mrow><mo>(</mo><mi>k</mi><mo>&NotEqual;</mo><mrow><mo>(</mo><mi>i</mi><mo>,</mo><mi>i</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>&Element;</mo><mi>I</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow></math>]]></maths>设j∈J为误差变化<img file="FDA0000075468040000045.GIF" wi="22" he="36" />的个数,则对于<img file="FDA0000075468040000046.GIF" wi="263" he="69" />有<maths num="0010"><![CDATA[<math><mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>B</mi><mi>j</mi></msub><mrow><mo>(</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover></mrow><mrow><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mi>j</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>B</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mrow><mo>(</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>=</mo><mfrac><mrow><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>-</mo><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mi>j</mi></msub></mrow><mrow><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mi>j</mi></msub></mrow></mfrac></mtd></mtr><mtr><mtd><msub><mi>B</mi><mi>t</mi></msub><mrow><mo>(</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>=</mo><mn>0</mn><mrow><mo>(</mo><mi>t</mi><mo>&NotEqual;</mo><mrow><mo>(</mo><mi>j</mi><mo>,</mo><mi>j</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow><mo>&Element;</mo><mi>J</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>8</mn><mo>)</mo></mrow></mrow></math>]]></maths>模糊推理函数为<maths num="0011"><![CDATA[<math><mrow><msub><mi>f</mi><mi>ij</mi></msub><mo>=</mo><msub><mi>A</mi><mi>i</mi></msub><mrow><mo>(</mo><mi>e</mi><mo>)</mo></mrow><msub><mi>B</mi><mi>j</mi></msub><mrow><mo>(</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow></mrow></math>]]></maths>(i∈I,j∈J)(9)式中A<sub>i</sub>(e)和<img file="FDA0000075468040000049.GIF" wi="117" he="62" />(i∈I,j∈J)分别表示e和<img file="FDA00000754680400000410.GIF" wi="22" he="37" />的相应输入量模糊集合;采用重心法对输出量模糊集进行去模糊化,则得到模糊推理机的实际输出为:<maths num="0012"><![CDATA[<math><mrow><mi>u</mi><mo>=</mo><mfrac><mrow><munder><mi>&Sigma;</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></munder><msub><mi>f</mi><mi>ij</mi></msub><msub><mi>u</mi><mi>ij</mi></msub></mrow><mrow><munder><mi>&Sigma;</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></munder><msub><mi>f</mi><mi>ij</mi></msub></mrow></mfrac><mo>=</mo><mfrac><mrow><munder><mi>&Sigma;</mi><munder><mrow><mi>k</mi><mo>=</mo><mrow><mo>(</mo><mi>i</mi><mo>,</mo><mi>i</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mrow><mrow><mi>t</mi><mo>=</mo><mrow><mo>(</mo><mi>j</mi><mo>,</mo><mi>j</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mrow></munder></munder><mrow><mo>(</mo><msub><mi>A</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>e</mi><mo>)</mo></mrow><msub><mi>B</mi><mi>t</mi></msub><mrow><mo>(</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>)</mo></mrow><msub><mi>u</mi><mi>kt</mi></msub></mrow><mrow><munder><mi>&Sigma;</mi><munder><mrow><mi>k</mi><mo>=</mo><mrow><mo>(</mo><mi>i</mi><mo>,</mo><mi>i</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mrow><mrow><mi>t</mi><mo>=</mo><mrow><mo>(</mo><mi>j</mi><mo>,</mo><mi>j</mi><mo>+</mo><mn>1</mn><mo>)</mo></mrow></mrow></munder></munder><mrow><mo>(</mo><msub><mi>A</mi><mi>k</mi></msub><mrow><mo>(</mo><mi>e</mi><mo>)</mo></mrow><msub><mi>B</mi><mi>t</mi></msub><mrow><mo>(</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>)</mo></mrow><mo>)</mo></mrow></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>10</mn><mo>)</mo></mrow></mrow></math>]]></maths>式中,u<sub>kt</sub>∈{-3,-2,-1,0,1,2,3}为推理机模糊输出值的数值化表示,u∈R为模糊PID控制器输出,其他参数定义见公式(9);定义模糊PID控制器参数k<sub>P</sub>、k<sub>I</sub>和k<sub>D</sub>的调整算式如下:<maths num="0013"><![CDATA[<math><mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>k</mi><mi>P</mi></msub><mo>=</mo><msub><mi>k</mi><mrow><mi>P</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>f</mi><mo>{</mo><mi>e</mi><mo>,</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>}</mo><msub><mi>k</mi><mi>P</mi></msub><mo>=</mo><msub><mi>k</mi><mrow><mi>P</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>k</mi><mi>P</mi></msub></mtd></mtr><mtr><mtd><msub><mi>k</mi><mi>I</mi></msub><mo>=</mo><msub><mi>k</mi><mrow><mi>I</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>f</mi><mo>{</mo><mi>e</mi><mo>,</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>}</mo><msub><mi>k</mi><mi>I</mi></msub><mo>=</mo><msub><mi>k</mi><mrow><mi>I</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>k</mi><mi>I</mi></msub></mtd></mtr><mtr><mtd><msub><mi>k</mi><mi>D</mi></msub><mo>=</mo><msub><mi>k</mi><mrow><mi>D</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>f</mi><mo>{</mo><mi>e</mi><mo>,</mo><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mo>}</mo><msub><mi>k</mi><mi>D</mi></msub><mo>=</mo><msub><mi>k</mi><mrow><mi>D</mi><mn>0</mn></mrow></msub><mo>+</mo><mi>&Delta;</mi><msub><mi>k</mi><mi>D</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>11</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,k<sub>P</sub>为模糊PID控制器的输出参数中的比例系数;k<sub>I</sub>为模糊PID控制器的输出参数中的积分系数;k<sub>D</sub>为模糊PID控制器的输出参数中的微分系数;比例系数k<sub>P</sub>增加,则系统的响应速度快,但超调量增加;积分系数k<sub>I</sub>增加,则系统的稳态误差消除快,但过渡过程超调大;微分系数k<sub>D</sub>增加,则系统动态特性好,但抗干扰能力变差;k<sub>P0</sub>、k<sub>I0</sub>和k<sub>D0</sub>为相应参数的初始值;Δk<sub>P</sub>、Δk<sub>I</sub>和Δk<sub>D</sub>为在线控制过程中,由模糊PID控制器输出的参数调整量;在机构运动过程中,在线检测加载支链实际的驱动力和指令值之间的差值e和<img file="FDA0000075468040000053.GIF" wi="48" he="43" />由上式完成模糊PID控制器的参数调整;整个控制的流程图如图7;b.反馈系统控制该六维力高频疲劳试验机的反馈系统也应用力伺服控制;该力伺服控制将压力传感器安装在6-UPS并联机构加载支链上,通过6个加载支链上的压力传感器得到力反馈信号,通过对6个加载的反馈信号的处理,进而对6-UPS并联机构的动平台进行力伺服控制,该力伺服控制的优点在于单个力输出不存在相互干扰的问题,通过6-UPS并联机构力的反解很容易得到加载平台合力的结果,再通过模糊PID控制器就对当前信号进行对比、分析、控制;并且应用力伺服控制时,各个加载支链的互换性较好;c.系统软件该六维力高频疲劳试验机软件部分采用分层结构,按照功能分成4个部分,分别完成人机界面层、数据/参数管理层、通讯层及控制层;人机界面层主要完成运动模式选择、运动参数输入、运动启动/停止控制的操作任务,同时需要与数据库连接,将系统控制设置参数以及运动过程中的状态参数显示,以便对运动过程进行人工干预,因此它的关联部分为数据库;数据/参数管理层实际上就是一个数据库,需要管理的数据主要包括:各类系统控制参数、默认参数及运动状态;通讯层主要任务就是根据具体的硬件进行时序协调管理;在该软件系统中,控制层即对运动控制卡及筒式直线电机驱动器的编程及调试;为了使软件系统达到良好的控制效果,要保证运动的稳定性、准确性及快速性,控制层的主要工作包括筒式直线电机驱动器与运动控制卡连接,系统反馈控制与运动控制卡连接以及6-UPS并联机构本身位置与运动控制卡的连接;为了增强系统软件的实时性和系统软件适应高频加载试验的需要,利用多线程技术对软件进行编写;利用多线程来优化系统软件,就是把程序的循环模块单独放在一个线程中来执行,把它与主线程隔离开,让主线程来完成循环模块以外的所有其他功能;循环模块所在的线程是一个高速运行的线程,依靠循环完成不停采集数据和控制等功能;而窗体的主线程除了负责循环模块以外的其他功能外,还负责响应用户输入;这样可以很好的提高系统软件的实时性;
地址 100191 北京市海淀区学院路37号
您可能感兴趣的专利