一种用于确定9自由度机械臂的全部奇异构型的方法与流程
本发明涉及机械臂技术领域，更具体地涉及一种用于确定9自由度机械臂的全部奇异构型的方法，该9自由度机械臂由4个相同的偏心关节以及一个单独的关节构成。
背景技术：
实际中，当机械臂处于某一构型时，其将会失去一个或多个自由度，此时称机械臂处于奇异构型或速度退化构型。因为机械臂处于奇异构型时，机械臂的末端在某些方向的速度为零，即失去了某些方向上的运动能力，导致其灵活度降低。
当机械臂靠近其奇异位置时，机械臂末端很小的位移，却需要很大的关节速度。当这样的关节速度超过了关节的驱动能力时，会引起末端轨迹偏离期望的轨迹，甚至对机械臂产生损坏。而当期望的位姿处于奇异构型时，可能存在无数个对应的关节构型，这给任务规划带来了困难。由此可见，机械臂的奇异性对机械臂的控制影响极大。机械臂的奇异分析的目的主要是寻找机械臂出现奇异的条件，因为深入理解机械臂的奇异性，可以更好地预测在特定条件下的行为，更有针对性地进行机械臂的任务规划，从而更好地对机械臂进行控制。
机械臂的奇异分析方面的研究已经持续很长时间了。最常用的方法就是使机械臂的雅克比矩阵为0,这时机械臂处于奇异构型。但是这种方法仅限于非冗余机械臂，而对于冗余机械臂，由于雅克比矩阵不是方阵，则意味着如果机械臂处于奇异构型，则其雅克比矩阵不是行满秩。
从而，需要找到一种新的方法，其能用于确定其雅克比矩阵并非行满秩的冗余机械臂的全部奇异构型。
技术实现要素：
为解决上述技术问题，本发明的一个主要方面提供一种用于确定9自由度机械臂的全部奇异构型的方法，其中该9自由度机械臂由4个相同的偏心关节以及一个单独的关节构成，该方法包括：从组成该9自由度机械臂的雅克比矩阵[j]＝[$1,$2,......,$k]的9个旋量中选择6个旋量，得到基子矩阵[$bsub]，该基子矩阵[$bsub]满足不满秩，即|[$bsub]|＝0，此处k＝9，$i表示第i个关节旋量；确定一个空间旋量w，使其与基子矩阵中所有的关节旋量互易，即该空间旋量w满足
本发明的技术方案克服了现有技术不能确定冗余机械臂的奇异构型的缺点，同时，它还具有分析计算方便可靠性较高等特点。
附图说明
图1为示出应用本发明的方法的9自由度机械臂的简图；
图2为示意性地示出本发明的方法的各主要步骤的流程图。
具体实施方式
下面结合附图对本发明作更进一步的说明。需要指出的是，这些说明只是示例性的，并不对本发明构成限制。
本公开将详细阐述一种用于确定9自由度机械臂的全部奇异构型的方法。如图1所示，这一9自由度机械臂由4个偏心关节组成，为了增加机械臂的灵活性，在其末端又加上了一个转动轴，这使得这一9自由度机械臂具有一定的可重构功能。另外，具体地，每一个偏心关节具有两个相互垂直的自由度，从而使得该9自由度机械臂具有更高的灵活度。
本公开将采用基于旋量的方法来对机械臂进行奇异分析。旋量可以表示为如下形式
其中s和s0是单位螺旋，h是螺旋的节距。机械臂的转动关节可以表示为一个0节距的螺旋，即$rjoint＝[ss0]t，移动关节可以表示为一个节距无穷大的一个旋量，即$pjoint＝[03×1s0]t。本公开中的9自由度机械臂中的偏心关节全是转动关节，因此本公开中的关节旋量全是0节距旋量。
机械臂的雅克比矩阵可以表示成旋量形式，即[j]＝[$1,$2,......,$k]，其中k表示机械臂具有k个自由度，在本公开中k＝9，$i表示第i个关节旋量。当机械臂处于奇异构型时这个6×9矩阵将不是行满秩。
在本发明中，将应用旋量互易法来确定该9自由度机械臂的奇异构型。如图2所示：首先，在步骤st1中，需要在9个旋量中找出6个旋量作为基旋量，其组成的旋量矩阵成为基子矩阵，即[$bsub]。对9自由度机械臂进行奇异分析，令该基子矩阵的行列式为0，即找出基子矩阵不满秩的情况。
|[$bsub]|＝0(2)
式中$bsub为去掉k-6个自由度的基子矩阵。因为该9自由度机械臂如果处于奇异构型，则任意6个关节旋量组成的基子矩阵的行列式必为0。
其次，因为基子矩阵$bsub不满秩，所以必然存在一个空间旋量w与基子矩阵中所有的关节旋量互易，即在步骤st2中，确定这个空间旋量w,使得
第三，由于机械臂处于奇异构型，则在步骤st3中，使w与剩下的k-6个关节旋量也互易，即
则经过这三步则可找到机械臂所有的奇异构型。更具体地，应当懂得，由上述三个步骤中的公式确定的方程组对应无数个解，而只要机械臂关节的角度满足该方程组，机械臂即处于奇异构型，因而，由上述三个步骤中的公式确定的方程组即以定量的方式确定了机械臂的奇异构型。
以下，将结合图1详细说明根据本发明的用于确定前述9自由度机械臂的全部奇异构型的方法。
可以看出这一机械臂全是由转动关节组成，每一个相邻的关节互相垂直，可以列出机械臂的d-h参数如表1。
表19自由度机械臂d-h参数
为了计算简单，选择图1中z5和x5所在的第5个关节坐标系作为参考坐标系，根据以上的d-h参数表，导出每一个关节所对应的变换矩阵，再代入上述旋量的基础公式即式(1)，可得到其余各个关节的运动旋量的坐标如下：
其中si＝sin(θi),ci＝cos(θi),sij＝sin(θi+θj),cij＝cos(θi+θj)。
为了计算方便，选择$3到$8作为基子矩阵，则可得基子矩阵为：
可以求出基子矩阵的行列式为：
|$sub|＝l2l3[(l3c7+sc67+s)s45s5c6-(l2c4+sc45+s)c5s6s67](6)
由|[$sub]|＝0可以得到15种情况。
1.l3c7+sc67+s＝0,l2c4+sc45+s＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w1＝[c5c6-s5c6c5s60-sc5s60]t(8)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
2.l3c7+sc67+s＝0,c5＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w2＝[010000]t(11)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
3.l3c7+sc67+s＝0,s6＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w3＝[c5-s50000]t(14)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
4.l3c7+sc67+s＝0,s67＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
5.s45＝0,l2c4+sc45+s＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
6.s45＝0,c5＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w6＝[0-s670l3c7+sc67+s00]t(23)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
7.s45＝0,s6＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
8.s45＝0,s67＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w8＝[000100]t(29)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
9.s5＝0,l2c4+sc45+s＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w9＝[c60s60-ss60]t(32)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
10.s5＝0,s6＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w10＝[100000]t(35)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
11.s5＝0,s67＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
12.c6＝0,l2c4+sc45+s＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w12＝[0010-s0]t(41)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
13.c6＝0,c5＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
14.c6＝0,s67＝0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
w14＝[00s45l2c4+sc45+s-ss450]t(47)
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
15.(l3c7+sc67+s)s45s5c6-(l2c4+sc45+s)c5s6s67＝0,(l3c7+sc67+s)s45s5c6≠0,(l2c4+sc45+s)c5s6s67≠0
这种情况下，基子矩阵变为
由此可得与基子矩阵中所有旋量都互易的旋量w为
如果机械臂处于奇异构型，则w与另外的三个旋量互易，则可得：
至此，已经将9自由度机械臂的所有缺失一个自由度的奇异情况都列出来了。
以上所述仅是本发明的优选实施方式，应当指出：对于本技术领域的普通技术人员来说，在不脱离本发明原理的前提下，还可以对以上叙述的实施方式做出若干改进和润饰，这些改进和润饰也应视为落在本发明的保护范围之内。本发明的保护范围由所附的权利要求加以限定。
- 还没有人留言评论。精彩留言会获得点赞！