发明名称 一种标准六自由度并联机构全局优化设计方法
摘要 本发明公开了一种标准六自由度并联机构全局优化设计方法,考虑并联机构的负载特性,给出了满足局部最佳动态各向同性的标准Stewart并联机构结构参数设计方法。在此基础上基于模态分析理论提出了一种全局动态各向同性指标,采用该指标作为优化目标,通过优化结构参数实现了并联机构的具体参数设计。采用该发明设计的并联机构,不仅实现了控制中心的完全解耦及动态各向同性,而且保证了全域工作空间内的最优性能。该发明从结构设计角度消除了并联机构的本征耦合特性,提升了并联机构性能,从而放宽及降低了工业中为了提升控制性能对并联机构复杂控制策略的需求。
申请公布号 CN103605896A 申请公布日期 2014.02.26
申请号 CN201310626619.9 申请日期 2013.11.21
申请人 哈尔滨工业大学 发明人 田体先;姜洪洲;佟志忠;何景峰
分类号 G06F19/00(2011.01)I 主分类号 G06F19/00(2011.01)I
代理机构 代理人
主权项 1.一种标准六自由度并联机构全局优化设计方法,其特征在于,方法如下:步骤1:确定系统雅克比矩阵根据负载特性M<sub>t</sub>,计算满足最佳局部动态各向同性的中位雅可比矩阵J<sub>l,x</sub>:<maths num="0001"><![CDATA[<math><mrow><msub><mi>J</mi><mrow><mi>l</mi><mo>,</mo><mi>x</mi></mrow></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>1</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><msub><mi>v</mi><mn>1</mn></msub><mi>T</mi></msup></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>2</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><msub><mi>v</mi><mn>2</mn></msub><mi>T</mi></msup></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>3</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><msub><mi>v</mi><mn>3</mn></msub><mi>T</mi></msup></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>4</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><msub><mi>v</mi><mn>4</mn></msub><mi>T</mi></msup></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>5</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><msub><mi>v</mi><mn>5</mn></msub><mi>T</mi></msup></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>6</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><msub><mi>v</mi><mn>6</mn></msub><mi>T</mi></msup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></math>]]></maths>式(1)中:<maths num="0002"><![CDATA[<math><mrow><msub><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><msub><mi>&gamma;</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>cos</mi><mrow><mo>(</mo><msub><mi>&beta;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><msub><mi>&gamma;</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><msub><mi>&beta;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><msub><mi>&gamma;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>,</mo><msub><mi>v</mi><mi>i</mi></msub><mo>=</mo><mi>r</mi><mfenced open='[' close=']'><mtable><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><msub><mi>&gamma;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mo>-</mo><mi>cos</mi><mrow><mo>(</mo><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><msub><mi>&gamma;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><msub><mi>&gamma;</mi><mi>i</mi></msub><mo>)</mo></mrow><mi>sin</mi><mrow><mo>(</mo><msub><mi>&beta;</mi><mi>i</mi></msub><mo>-</mo><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>标准六自由度并联机构的结构参数包括:欧拉角α<sub>i</sub>、欧拉角β<sub>i</sub>、欧拉角γ<sub>i</sub>、半径r,上述参数满足约束条件:γ<sub>i</sub>=γ,i=1…6<maths num="0003"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>=</mo><msub><mi>&alpha;</mi><mn>0</mn></msub><mo>,</mo><msub><mi>&alpha;</mi><mn>3</mn></msub><mo>=</mo><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>+</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi><mo>,</mo><msub><mi>&alpha;</mi><mn>5</mn></msub><mo>=</mo><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>-</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi></mtd></mtr><mtr><mtd><msub><mi>&alpha;</mi><mn>6</mn></msub><mo>=</mo><mo>-</mo><msub><mi>&alpha;</mi><mn>1</mn></msub><mo>,</mo><msub><mi>&alpha;</mi><mn>2</mn></msub><mo>=</mo><msub><mi>&alpha;</mi><mn>6</mn></msub><mo>+</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi><mo>,</mo><msub><mi>&alpha;</mi><mn>4</mn></msub><mo>=</mo><msub><mi>&alpha;</mi><mn>6</mn></msub><mo>-</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi></mtd></mtr></mtable></mfenced></math>]]></maths><maths num="0004"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>&beta;</mi><mn>1</mn></msub><mo>=</mo><msub><mi>&beta;</mi><mn>0</mn></msub><mo>,</mo><msub><mi>&beta;</mi><mn>3</mn></msub><mo>=</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mo>+</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi><mo>,</mo><msub><mi>&beta;</mi><mn>5</mn></msub><mo>=</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mo>-</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi></mtd></mtr><mtr><mtd><msub><mi>&beta;</mi><mn>6</mn></msub><mo>=</mo><mo>-</mo><msub><mi>&beta;</mi><mn>1</mn></msub><mo>,</mo><msub><mi>&beta;</mi><mn>2</mn></msub><mo>=</mo><msub><mi>&beta;</mi><mn>6</mn></msub><mo>+</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi><mo>,</mo><msub><mi>&beta;</mi><mn>4</mn></msub><mo>=</mo><msub><mi>&beta;</mi><mn>6</mn></msub><mo>-</mo><mfrac><mn>2</mn><mn>3</mn></mfrac><mi>&pi;</mi></mtd></mtr></mtable></mfenced></math>]]></maths>负载特性M<sub>t</sub>=[m<sub>x</sub> m<sub>y</sub> m<sub>z</sub> I<sub>xx</sub> I<sub>yy</sub> I<sub>zz</sub>]应满足:m<sub>x</sub>=m<sub>y</sub>=m<sub>z</sub>=m,I<sub>xx</sub>=I<sub>yy</sub>;m<sub>x</sub>为沿x方向质量参数,m<sub>y</sub>为沿y方向质量参数,m<sub>z</sub>为沿z方向质量参数,I<sub>xx</sub>为沿x方向惯性参数,I<sub>yy</sub>为沿y方向惯性参数,I<sub>zz</sub>为沿z方向惯性参数;参数α<sub>0</sub>、β<sub>0</sub>、γ、r满足约束条件:<maths num="0005"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>&beta;</mi><mn>0</mn></msub><mo>=</mo><msub><mi>&alpha;</mi><mn>0</mn></msub><mo>&PlusMinus;</mo><mfrac><mi>&pi;</mi><mn>2</mn></mfrac></mtd></mtr><mtr><mtd><mi>&gamma;</mi><mo>=</mo><mi>arctan</mi><mroot><mfrac><msub><mi>I</mi><mi>xx</mi></msub><msub><mi>I</mi><mi>zz</mi></msub></mfrac><mn>4</mn></mroot></mtd></mtr><mtr><mtd><mi>r</mi><mo>=</mo><msqrt><mfrac><msub><mi>I</mi><mi>xx</mi></msub><mi>m</mi></mfrac></msqrt><mo>/</mo><mi>tan</mi><mi>&gamma;</mi></mtd></mtr></mtable></mfenced></math>]]></maths>步骤2:选择优化参数给定支腿长度l及欧拉角α<sub>0</sub>则给定并联机构的结构参数,故选择优化参数为:支腿长度l、欧拉角α<sub>0</sub>;采用单参数优化,每次优化取上述各参数其中之一;步骤3:结构参数计算对并联机构的结构参数设计实质为根据步骤1中获得的中位雅可比矩阵J<sub>l,x</sub>求取上下平台铰点空间阵A和B;上平台铰点空间阵:<img file="FSA0000098297320000021.GIF" wi="689" he="91" />下平台铰点空间阵:B=[b<sub>1</sub> b<sub>2</sub> b<sub>3</sub> b<sub>4</sub> b<sub>5</sub> b<sub>6</sub>]<img file="FSA0000098297320000022.GIF" wi="53" he="54" />为上平台各铰点空间矢量,b<sub>i</sub>为下平台各铰点空间矢量i=1,2…6;计算过程如下:<maths num="0006"><![CDATA[<math><mrow><msubsup><mi>a</mi><mi>i</mi><mi>m</mi></msubsup><mo>=</mo><mi>r</mi><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mrow><mo>(</mo><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>sin</mi><mrow><mo>(</mo><msub><mi>&alpha;</mi><mi>i</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>L<sub>0</sub>=l·[l<sub>n,1</sub> l<sub>n,2</sub> l<sub>n,3</sub> l<sub>n,4</sub> l<sub>n,5</sub> l<sub>n,6</sub>]B=A-L<sub>0</sub>步骤4:建立全局动态各向同性指标<maths num="0007"><![CDATA[<math><mrow><msub><mi>&eta;</mi><mi>g</mi></msub><mrow><mo>(</mo><msub><mi>&alpha;</mi><mn>0</mn></msub><mo>,</mo><mi>l</mi><mo>)</mo></mrow><mo>=</mo><msqrt><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mi>j</mi><mo>=</mo><mn>1</mn></mrow><mn>6</mn></munderover><msub><mi>h</mi><mrow><mi>i</mi><mo>,</mo><mi>j</mi></mrow></msub><mfrac><msubsup><mi>H</mi><mrow><mi>Li</mi><mo>,</mo><mi>j</mi></mrow><mn>2</mn></msubsup><mn>36</mn></mfrac></msqrt><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中h<sub>i,j</sub>为权重系数,0≤h<sub>i,j</sub>≤1,<img file="FSA0000098297320000025.GIF" wi="238" he="130" />H<sub>L</sub>为模态灵敏度矩阵:<img file="FSA0000098297320000026.GIF" wi="1424" he="321" />其中:<img file="FSA0000098297320000031.GIF" wi="900" he="130" /><img file="FSA0000098297320000032.GIF" wi="766" he="139" /><img file="FSA0000098297320000033.GIF" wi="879" he="130" /><img file="FSA0000098297320000034.GIF" wi="805" he="141" /><img file="FSA0000098297320000035.GIF" wi="849" he="130" /><img file="FSA0000098297320000036.GIF" wi="812" he="149" />△为相应自由度上的摄动量,如Δx=[ε 0 0 0 0 0]<sup>T</sup>,ε为一微小摄动量,ε=10<sup>-5</sup>;<maths num="0008"><![CDATA[<math><mrow><msub><mi>G</mi><mi>T</mi></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mo>=</mo><msubsup><mi>M</mi><mi>t</mi><mrow><mo>-</mo><mn>1</mn></mrow></msubsup><msubsup><mi>J</mi><mrow><mi>l</mi><mo>,</mo><mi>x</mi></mrow><mi>T</mi></msubsup><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><msub><mi>J</mi><mrow><mi>l</mi><mo>,</mo><mi>x</mi></mrow></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow></mrow></math>]]></maths><img file="FSA0000098297320000038.GIF" wi="466" he="66" />雅可比矩阵J<sub>l,x</sub>(x):<maths num="0009"><![CDATA[<math><mrow><msub><mi>J</mi><mrow><mi>l</mi><mo>,</mo><mi>x</mi></mrow></msub><mrow><mo>(</mo><mi>x</mi><mo>)</mo></mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>1</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><mrow><mo>(</mo><msubsup><mi>Ta</mi><mn>1</mn><mi>m</mi></msubsup><mo>&times;</mo><msub><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>1</mn></mrow></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>2</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><mrow><mo>(</mo><msubsup><mi>Ta</mi><mn>2</mn><mi>m</mi></msubsup><mo>&times;</mo><msub><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>2</mn></mrow></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><mo>.</mo></mtd><mtd><mo>.</mo></mtd></mtr><mtr><mtd><msubsup><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>6</mn></mrow><mi>T</mi></msubsup></mtd><mtd><msup><mrow><mo>(</mo><msubsup><mi>Ta</mi><mn>6</mn><mi>m</mi></msubsup><mo>&times;</mo><msub><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mn>6</mn></mrow></msub><mo>)</mo></mrow><mi>T</mi></msup></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中:<img file="FSA00000982973200000310.GIF" wi="603" he="83" />l<sub>n,i</sub>为各支腿空间单位矢量,i=1,2…6;<maths num="0010"><![CDATA[<math><mrow><msub><mi>l</mi><mrow><mi>n</mi><mo>,</mo><mi>i</mi></mrow></msub><mo>=</mo><mfrac><msub><mi>l</mi><mi>i</mi></msub><mrow><mo>|</mo><mo>|</mo><msub><mi>l</mi><mi>i</mi></msub><mo>|</mo><mo>|</mo></mrow></mfrac><mo>=</mo><mfrac><mrow><msub><mi>Ta</mi><mi>i</mi></msub><mo>+</mo><mi>c</mi><mo>-</mo><msub><mi>b</mi><mi>i</mi></msub></mrow><mrow><mo>|</mo><mo>|</mo><msub><mi>Ta</mi><mi>i</mi></msub><mo>+</mo><mi>c</mi><mo>-</mo><msub><mi>b</mi><mi>i</mi></msub><mo>|</mo><mo>|</mo></mrow></mfrac></mrow></math>]]></maths>平动矢量c=[x y z]<sup>T</sup><img file="FSA00000982973200000312.GIF" wi="1008" he="226" />c表示cos,s表示sin;步骤5:生成优化曲线首先令欧拉角α<sub>0</sub>=0,绘制曲线f=η<sub>g</sub>(0,l),并寻找最值l<sub>min</sub>,其次固定参数l<sub>min</sub>,绘制曲线f=η<sub>g</sub>(α<sub>0</sub>,l<sub>min</sub>),并寻找最值α<sub>0min</sub>;步骤6:校核检验设计的结构参数是否存在干涉,若存在,返回步骤5重新对参数进行优化;步骤7:结束。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号哈尔滨工业大学机电工程学院