发明名称 基于螺旋空间交集运算的并联机构自由度分折方法
摘要 本发明公开了一种基于螺旋空间交集运算的并联机构自由度分析方法。该方法的步骤如下:计算支链螺旋空间的维数;计算双支链单环机构动平台自由度;计算两条支链螺旋空间的交集空间;计算多环并联机构动平台的自由度;布置并联机构的驱动器;识别支链中可能存在的局部自由度;计算并联机构的整体自由度。本发明能够无例外地正确计算所有类型并联机构的动平台自由度和机构整体自由度;对于单环机构,无需求取双支链螺旋空间的交集空间,而能直接获得动平台自由度;对于两条支链螺旋空间并集的维数等于一条支链螺旋矩阵的秩,或者等于两条支链螺旋矩阵的秩之和的情况,能够直接获得交集空间而无需任何运算。
申请公布号 CN102689306B 申请公布日期 2014.07.02
申请号 CN201210189531.0 申请日期 2012.06.08
申请人 浙江大学 发明人 刘振宇;卜王辉;谭建荣
分类号 B25J9/16(2006.01)I 主分类号 B25J9/16(2006.01)I
代理机构 杭州求是专利事务所有限公司 33200 代理人 林怀禹
主权项 1.一种基于螺旋空间交集运算的并联机构自由度分析方法,其特征在于该方法的步骤如下:(1)计算支链螺旋空间的维数:设$<sup>i</sup>j为第i条支链中第j个运动副的螺旋向量,则支链i各运动副组成的运动螺旋的集合为M<sub>i</sub>={$<sup>i</sup>1,$<sup>i</sup>2,…,$<sup>i</sup>n<sub>i</sub>},集合构成的矩阵的秩为Rank(M<sub>i</sub>)≤6,因此支链i的运动螺旋构成Rank(M<sub>i</sub>)维螺旋空间,记为A<sub>i</sub>,螺旋空间A<sub>i</sub>的维数Dim(A<sub>i</sub>)=Rank(M<sub>i</sub>);(2)计算双支链单环机构动平台自由度:一条支链螺旋空间A<sub>1</sub>的维数Dim(A<sub>1</sub>)=Rank(M<sub>1</sub>),另一条支链螺旋空间A<sub>2</sub>的维数Dim(A<sub>2</sub>)=Rank(M<sub>2</sub>),M<sub>1</sub>∪M<sub>2</sub>={$<sup>1</sup>1,$<sup>1</sup>2,…,$<sup>1</sup>n<sub>1</sub>,$<sup>2</sup>1,$<sup>2</sup>2,…,$<sup>2</sup>n<sub>2</sub>},则螺旋空间A<sub>1</sub>和A<sub>2</sub>的并集空间的维数Dim(A<sub>1</sub>∪A<sub>2</sub>)=Rank(M<sub>1</sub>∪M<sub>2</sub>),因此单环并联机构动平台自由度计算为DOF(MovingPlatform)=Rank(M<sub>1</sub>)+Rank(M<sub>2</sub>)-Rank(M<sub>1</sub>∪M<sub>2</sub>)    (1);(3)计算两条支链螺旋空间的交集空间:根据两条支链的运动螺旋集合M<sub>1</sub>和M<sub>2</sub>及其并集M<sub>1</sub>∪M<sub>2</sub>,计算这些集合构成的螺旋矩阵的秩N<sub>1</sub>=Rank(M<sub>1</sub>),N<sub>2</sub>=Rank(M<sub>2</sub>),N<sub>3</sub>=Rank(M<sub>1</sub>∪M<sub>2</sub>),假定N<sub>1</sub>≥N<sub>2</sub>,显然N<sub>3</sub>&gt;=N<sub>1</sub>,如果N<sub>3</sub>=N<sub>1</sub>,则A<sub>1</sub>∩A<sub>2</sub>=A<sub>2</sub>,即A<sub>2</sub>就是螺旋空间A1∩A2的交集空间,如果N<sub>3</sub>=N<sub>1</sub>+N<sub>2</sub>,说明M<sub>2</sub>中全体螺旋向量对M<sub>1</sub>∪M<sub>2</sub>中螺旋向量的数目都有贡献,即螺旋空间A<sub>1</sub>与螺旋空间A<sub>2</sub>互不包含,此时A1∩A2=<img file="FDA0000465007220000012.GIF" wi="43" he="55" />,即机构不能运动,如果N<sub>1</sub>&lt;N<sub>3</sub>&lt;N<sub>1</sub>+N<sub>2</sub>,说明M<sub>2</sub>中部分螺旋向量对M<sub>1</sub>∪M<sub>2</sub>中螺旋向量的数目有贡献,A<sub>1</sub>∩A<sub>2</sub>螺旋空间中的基螺旋数目为N<sub>1</sub>+N<sub>2</sub>-N<sub>3</sub>,此时需要按如下步骤计算A<sub>1</sub>∩A<sub>2</sub>的基螺旋的:(3.1)在6维空间中分别计算螺旋空间A<sub>1</sub>和A<sub>2</sub>的补集空间,记为T<sub>1</sub>和T<sub>2</sub>,显然T<sub>1</sub>∪A<sub>1</sub>=T<sub>2</sub>∪A<sub>2</sub>=R<sup>6</sup>,若螺旋向量用$=(l,m,n,p,q,r)<sup>T</sup>表示,则螺旋集合所构成的螺旋矩阵为<maths num="0001"><![CDATA[<math><mrow><mi>S</mi><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>l</mi><mn>1</mn></msub></mtd><mtd><msub><mi>l</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>l</mi><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mn>1</mn></msub></mtd><mtd><msub><mi>m</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>m</mi><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>n</mi><mn>1</mn></msub></mtd><mtd><msub><mi>n</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>n</mi><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>p</mi><mn>1</mn></msub></mtd><mtd><msub><mi>p</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>p</mi><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>q</mi><mn>1</mn></msub></mtd><mtd><msub><mi>q</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>q</mi><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>r</mi><mn>1</mn></msub></mtd><mtd><msub><mi>r</mi><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mi>r</mi><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mo>$</mo><mn>1</mn></msub></mtd><mtd><msub><mo>$</mo><mn>2</mn></msub></mtd><mtd><mo>.</mo><mo>.</mo><mo>.</mo></mtd><mtd><msub><mo>$</mo><mrow><mi>n</mi><mn>1</mn></mrow></msub></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>计算补集空间的方法就是求解以下齐次线性方程组S<sup>T</sup>x=0                        (2)方程组的非0解表示了补集空间的基螺旋,如此分别求出螺旋集合M<sub>1</sub>和M<sub>2</sub>中螺旋系的互补螺旋,将这两组互补螺旋的集合分别记为Q<sub>1</sub>和Q<sub>2</sub>,它们即分别为补集空间T<sub>1</sub>和T<sub>2</sub>的基螺旋;(3.2)按照步骤(3.1)计算T<sub>1</sub>和T<sub>2</sub>的并集空间T<sub>1</sub>∪T<sub>2</sub>,即并集Q<sub>1</sub>∪Q<sub>2</sub>中的基螺旋;(3.3)在6维空间中计算并集空间T<sub>1</sub>∪T<sub>2</sub>的补集空间,即为A<sub>1</sub>∩A<sub>2</sub>,显然(T<sub>1</sub>∪T<sub>2</sub>)∪(A<sub>1</sub>∩A<sub>2</sub>)=R<sup>6</sup>,计算方法是根据(式2)求解集合Q<sub>1</sub>∪Q<sub>2</sub>中各螺旋的互补螺旋,将其集合记为M<sub>12</sub>,则集合M<sub>12</sub>中有6-Rank(Q<sub>1</sub>∪Q<sub>2</sub>)条螺旋,它们即为A<sub>1</sub>∩A<sub>2</sub>的基螺旋,这些基螺旋张成的螺旋空间就是所要求的交集空间,交集空间的维数Dim(A<sub>1</sub>∩A<sub>2</sub>)=Rank(M<sub>12</sub>);(4)计算多环并联机构动平台的自由度:计算公式为DOF(MovingPlatform)=Rank(M<sub>12</sub>)+Rank(M<sub>3</sub>)-Rank(M<sub>12</sub>∪M<sub>3</sub>)    (3);(5)布置并联机构的驱动器:对于并联机构的任意两条支链,不含冗余驱动的并联机构驱动布置方案必须满足以下条件,一是去除掉配置驱动器的运动副后,支链运动螺旋集合M<sub>1</sub>’构成的螺旋矩阵的秩Rank(M<sub>1</sub>’)&lt;Rank(M<sub>1</sub>),同样Rank(M<sub>2</sub>’)&lt;Rank(M<sub>2</sub>),二是去除掉配置驱动器的运动副后,两条支链运动螺旋集合的并集M<sub>1</sub>’∪M<sub>2</sub>’构成的螺旋矩阵的秩Rank(M<sub>1</sub>’∪M<sub>2</sub>’)=Rank(M<sub>1</sub>∪M<sub>2</sub>),三是去除掉配置驱动器的运动副后,两条支链运动螺旋集合的并集构成的螺旋矩阵的秩Rank(M<sub>1</sub>’∪M<sub>2</sub>’)=Rank(M<sub>1</sub>’)+Rank(M<sub>2</sub>’);(6)识别支链中可能存在的局部自由度:对于按照步骤(5)进行驱动器布置的机构,排除各支链含有驱动器的运动副,然后计算各支链新的螺旋矩阵的秩,记为Rank(M<sup>2</sup><sub>i</sub>),然后去除一个驱动器,则支链增加一个原驱动器所在运动副的运动螺旋,计算新增一个运动螺旋之后支链螺旋矩阵的秩,记为Rank(M<sup>3</sup><sub>i</sub>),若Rank(M<sup>3</sup><sub>i</sub>)=Rank(M<sup>2</sup><sub>i</sub>),说明原驱动器所在运动副为局部自由度,这个驱动器确实应该去除掉,若Rank(M<sup>3</sup><sub>i</sub>)&gt;Rank(M<sup>2</sup><sub>i</sub>),说明原驱动器所在运动副不是局部自由度,这个驱动器不能去除,重复上述过程直到全部驱动器都完成检验,对于不再含有驱动器布置在局部自由度的机构,排除各支链含驱动器的运动副,然后计算各支链新的螺旋矩阵的秩Rank(M<sup>4</sup><sub>i</sub>),并计算此时支链所剩运动副的自由度之和W<sub>i</sub>,则各条支链的局部自由度数目ξ<sub>i</sub>=W<sub>i</sub>-Rank(M<sup>4</sup><sub>i</sub>);(7)计算并联机构的整体自由度:考虑了支链冗余运动螺旋和局部自由度的机构整体自由度公式为<maths num="0002"><![CDATA[<math><mrow><mi>DOF</mi><mrow><mo>(</mo><mi>Mechanism</mi><mo>)</mo></mrow><mo>=</mo><mi>DOF</mi><mrow><mo>(</mo><mi>MovingPlatform</mi><mo>)</mo></mrow><mo>+</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>I</mi></munderover><msub><mi>F</mi><mi>ri</mi></msub><mo>-</mo><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mn>1</mn></mrow><mi>I</mi></munderover><msub><mi>&xi;</mi><mi>i</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,支链冗余运动螺旋的自由度为<maths num="0003"><![CDATA[<math><mrow><msub><mi>f</mi><mi>ri</mi></msub><mo>=</mo><munderover><mi>&Sigma;</mi><mrow><mi>j</mi><mo>=</mo><mn>1</mn></mrow><msub><mi>g</mi><mi>i</mi></msub></munderover><msub><mi>F</mi><mi>ij</mi></msub><mo>-</mo><mi>Rank</mi><mrow><mo>(</mo><msub><mi>M</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow></math>]]></maths><img file="FDA0000465007220000033.GIF" wi="121" he="144" />表示支链中全体运动副自由度总和。
地址 310027 浙江省杭州市西湖区浙大路38号