2. 哈尔滨工业大学 机器人技术与系统国家重点实验室,黑龙江 哈尔滨 150080;
3. 江苏省食品先进制造装备技术重点实验室,江苏 无锡 214122
2. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150080, China;
3. Jiangsu Key Laboratory of Advanced Food Manufacturing Equipment and Technology, Wuxi 214122, China
作为一类新型机构,并联机构相对于传统的串联机构而言具备一些独特的优势[1-2],如精度高、累积误差小等。伴随着Delta机器人[3]在各条生产线上的广泛应用,并联机构逐渐走向快速发展的时期。而作为机构学的研究热点,国内外学者对并联机构的型综合已经做了大量的研究工作,其中主要包括三类,分别为:1) 由Hervé提出的基于位移群论的构型方法[4]; 2) HUANG引用螺旋理论提出了机构构型方法[5]; 3) 杨廷力结合机器人的拓扑结构提出了机器人构型方法[6]。
在并联机构的研究和应用中,机构输入和输出之间的耦合却成为了阻碍并联机构应用的一个难题。虽然耦合性使机构提高了刚度和承载能力,但耦合性给并联机构的应用也带来了局限性,所以解耦的并联机构,又逐步演变为新的研究热点[7-8]。由于解耦并联机构避免了机构输入与输出之间的耦合性,故其在精密仪器仪表、航空航天、高端制造装配等领域有广泛应用前景。国内外众多学者已经开展了相关的研究,如Carricato[9]、Gogu[10]、Kong、Gosselin[11]、侯雨雷[12]、高峰[13]、黄真[14]、曾达幸[15-16]、张帆[17]、张彦斌[18]等,但大部分学者的研究对象均为具有三自由度移动及转动特征的并联机构,关于三转两移(3R2T)解耦并联机构的构型综合却缺乏研究。
通过分析解耦并联机构的输入输出特点,基于支链独立驱动原理和螺旋理论提出了3R2T解耦并联机构构型综合方法。给定期望3R2T解耦并联机构的运动特征,根据解耦并联机构的正逆雅可比矩阵必为对角阵的结构特性。首先利用螺旋理论来构造出符合解耦并联机构特点的正逆雅可比矩阵; 其次根据所构造的正雅可比矩阵,即可得到驱动副作用于动平台上的使动螺旋; 再求得该使动螺旋对应支链上的表示驱动副的驱动螺旋和除驱动螺旋之外的其他运动螺旋系; 最后根据解耦并联机构的运动条件依次将五条支链连接到动定平台上,即可得到3R2T解耦并联机构。由于该并联机构的输出运动完全由支链上独立输入的驱动所提供,故属于解耦并联机构。
1 螺旋理论基础文献[19]研究表明:螺旋(screw)也称旋量。在空间机构分析中,其可以表示为运动关节所受力或者关节轴线的方向。可以用一组对偶矢量表示:
$\$=(S;\text{ }{{S}_{0}})=\left( S;\text{ }r\times S+hS \right)$ | (1) |
式中: S 和 S0 均为矢量, r 表示螺旋的位置矢量,h为螺旋的节距。螺旋也可用Plücker坐标表示为
$\$=(S;\text{ }{{S}_{0}})=\left( L\text{ }M\text{ }N;\text{ }P\text{ }Q\text{ }R \right)$ | (2) |
若两螺旋 $1(S; S0) 和 $2 (Sr; S0r) 的原部矢量与对偶部矢量下标相互交换后做点积之和,这个乘法被定义为两旋量的互易积,当螺旋 $1 和螺旋 $2 构成的互易积为0时,有
${{\$}_{1}}{}^\circ {{\$}_{2}}=S\cdot {{S}_{0}}^{r}+{{S}^{r}}\cdot {{S}_{0}}=0$ | (3) |
式中:螺旋 $1 和螺旋 $2 互为反螺旋。
使动螺旋表示机构动平台所受到的力的螺旋,当机构中的驱动副驱动时,机构的动平台会受到力或力偶的作用,用螺旋将该力/力偶表示出来,就称为使动螺旋[20]。
2 3R2T解耦并联机构输入输出分析对于3R2T解耦并联机构,基于互易螺旋理论其瞬时运动特性可如下描述。若 $ji 指代第i条支链上的第j个运动副的运动螺旋, q·ji 指速度, T 指动平台的输出速度矢量,则 T 可以用下式描述:
$T=\sum\limits_{j=1}^{{{F}_{i}}}{{{{\dot{q}}}_{ji}}}{{\$}_{ji}},\text{ }\$i=1,\text{ }2,\text{ }3,\text{ }4,\text{ }5$ | (4) |
式中: Fi 表示第i条分支的连接度。若 Tai 是第i条分支的使动螺旋,其表示该条支链上的驱动副作用于动平台的力/力偶。基于互易螺旋理论,则 Tai 与该支链上除驱动螺旋之外的其余所有运动螺旋互易积均为0。在等式(4) 左右两侧均乘以 $aiT 可得
$\${{T}_{ai}}\hat{T}=\$_{ai}^{T}{{{\hat{\$}}}_{1i}}{{{\dot{q}}}_{1i}},~i=1,\text{ }2,\text{ }3,\text{ }4,\text{ }5$ | (5) |
式中:
$\begin{align} & \left[ \begin{array}{*{35}{l}} {{\$}^{T}}_{a1} \\ {{\$}^{T}}_{a2} \\ {{\$}^{T}}_{a3} \\ {{\$}^{T}}_{a4} \\ {{\$}^{T}}_{a5} \\ \end{array} \right]\left[ \begin{matrix} v \\ w \\ \end{matrix} \right]= \\ & \left[ \begin{array}{*{35}{l}} {{\$}^{T}}{{_{a1}}_{1}}{{{\hat{\$}}}_{11}}_{1} & 0 & 0 & 0 & 0 \\ 0 & {{\$}^{T}}_{a2}{{{\hat{\$}}}_{12}} & 0 & 0 & 0 \\ 0 & 0 & {{\$}^{T}}_{a3}{{{\hat{\$}}}_{13}} & 0 & 0 \\ 0 & 0 & 0 & {{\$}^{T}}_{a4}{{{\hat{\$}}}_{14}} & 0 \\ 0 & 0 & 0 & 0 & {{\$}^{T}}_{a5}{{{\hat{\$}}}_{15}} \\ \end{array} \right]\left[ \begin{array}{*{35}{l}} {{{\dot{q}}}_{11}} \\ {{{\dot{q}}}_{12}} \\ {{{\dot{q}}}_{13}} \\ {{{\dot{q}}}_{14}} \\ {{{\dot{q}}}_{15}} \\ \end{array} \right] \\ \end{align}$ | (6) |
由于分支约束螺旋系限制,使 v 中平行于Z轴方向的任何分量都恒为0。此时对应的使动螺旋为 $ai (i=1, 2, 3, 4, 5) ,改变式(6) 中使动螺旋的形式可得
${{J}_{dir}}\hat{t}={{J}_{inv}}\dot{q}$ | (7) |
式中:
$\hat{t}=\left[ \begin{array}{*{35}{l}} {{v}_{x}} \\ {{v}_{y}} \\ {{w}_{x}} \\ {{w}_{y}} \\ {{w}_{z}} \\ \end{array} \right],\dot{q}=\left[ \begin{array}{*{35}{l}} {{{\dot{q}}}_{11}} \\ {{{\dot{q}}}_{12}} \\ {{{\dot{q}}}_{13}} \\ {{{\dot{q}}}_{14}} \\ {{{\dot{q}}}_{15}} \\ \end{array} \right]$ | (8) |
${{J}_{dir}}=\left[ \begin{array}{*{35}{l}} {{s}_{a1}}^{T} \\ {{s}_{a2}}^{T} \\ {{s}_{a3}}^{T} \\ {{s}^{T}}_{a4} \\ {{s}^{T}}_{a5} \\ \end{array} \right]$ | (9) |
${{J}_{inv}}=\left[ \begin{array}{*{35}{l}} {{\$}^{T}}_{a1}{{{\hat{\$}}}_{11}} & 0 & 0 & 0 & 0 \\ 0 & {{\$}^{T}}_{a2}{{{\hat{\$}}}_{12}} & 0 & 0 & 0 \\ 0 & 0 & {{\$}^{T}}_{a3}{{{\hat{\$}}}_{13}} & 0 & 0 \\ 0 & 0 & 0 & {{\$}^{T}}_{a4}{{{\hat{\$}}}_{14}} & 0 \\ 0 & 0 & 0 & 0 & {{\$}^{T}}_{a5}{{{\hat{\$}}}_{15}} \\ \end{array} \right]$ | (10) |
式中:
若 Jinv 为可逆矩阵,则:
$\dot{q}={{J}^{-1}}_{inv}{{J}_{dir}}\hat{t}$ | (11) |
$J={{J}^{-1}}_{inv}{{J}_{dir}}$ | (12) |
其中 J 表示机构的雅可比矩阵。
若能确保机构的正、逆雅可比矩阵均为对角阵,则该机构必定为解耦的并联机构。
3 3R2T解耦并联机构型综合原理结合上述结论提出了一种基于螺旋理论的3R2T解耦并联机构构型综合方法。通过确定使动螺旋、驱动螺旋的形式,来获得对角的正逆雅可比矩阵,进而可以得到满足条件的支链结构形式。具体流程图如图 1所示。
由文献[16]可知,并联移动解耦机构的驱动副既可是移动副也可是转动副。因此当驱动副为转动副时,该分支需具有一个转动副与驱动副构成2R平行子链(下文中简称2R平行子链转动副)。但为了不破坏机构的解耦特性,需要注意的是:由2R平行子链作为驱动副,会带来另一方向的驱动作用(称为消极驱动,即机构中在某一方向不希望出现的驱动),所以要求在该分支结构中需有一个移动副与该分支中存在的消极驱动方向共线,以便消除消极驱动对机构解耦特性的不利影响。基于以上分析,可依据独立驱动原则,利用螺旋理论完成3R2T解耦并联机构的构型。
4 机构支链型综合过程本文综合的3R2T解耦并联机构是基于独立驱动原则,即一条支链只含有一个驱动副,且控制动平台的一个对应的输出自由度。所以在下文的构型综合过程中,将假设前两条分支分别提供沿X与Y轴方向的移动驱动,第三、四、五条分支提供绕X、Y及Z轴方向的转动驱动。由于并联机构分支必具有动平台的运动特征,所以综合的每条支链的连接度至少为5。下文将根据上述构型原理,详细给出五条支链的构型过程。
4.1 第一条支链的型综合设该分支仅对动平台沿X轴方向的移动提供输入驱动,其正雅可比矩阵中第一排仅一个非零元素 [Jdir]11 。由于期望使动螺旋只对动平台沿X轴方向有驱动力,所以使动螺旋的形式只考虑为
${{\$}_{a1}}=\left[ 100;000 \right]$ | (13) |
即使动螺旋与定平台坐标系X轴重合。根据第三节分析可知,当使动螺旋为力线矢类螺旋时,驱动副可以是移动副或者是2R平行子链转动副,所以驱动螺旋有三种类型,其螺旋表达式为
$\left\{ \begin{matrix} {{\$}_{q11}}=\left[ 000;100 \right],\text{ }h=\infty \\ {{\$}_{q12}}=\left[ 010;{{d}_{12}}0{{f}_{12}} \right],\text{ }h=0 \\ {{\$}_{q13}}=\left[ 001;{{d}_{13}}{{e}_{13}}0 \right],\text{ }h=0 \\ \end{matrix} \right.$ | (14) |
式(14) 表示三种情况下,支链中的驱动副分别为沿X轴方向的移动副、绕Y轴方向和Z轴方向的2R平行转动副。将式(14) 代入式(10) 可得
$\left\{ \begin{matrix} {{\left[ {{J}_{v}} \right]}_{11}}={{\$}_{a1}}{}^\circ {{\$}_{q11}}=1 \\ {{\left[ {{J}_{v}} \right]}_{11}}={{\$}_{a1}}{}^\circ {{\$}_{q12}}={{d}_{12}} \\ {{\left[ {{J}_{v}} \right]}_{11}}={{\$}_{a1}}{}^\circ {{\$}_{q13}}={{d}_{13}} \\ \end{matrix} \right.$ | (15) |
由于d12和d13是与坐标系原点选择相关的变量,故只需调整驱动副的位置使d12和d13不为零,即可使式(15) 中三种情况下 [Jv]11 均不为零。根据反螺旋定理[19]可知支链中可能存在的螺旋系包括以下三种:
1) 与X轴平行的线矢量螺旋系,空间内平行的线矢量螺旋系维数最多为3,故其数量最多为3。
2) 与X轴垂直的偶量螺旋,由于共面的偶量螺旋最大线性无关数为2,所以其数量最多为2,且轴线方向不共线。
3) 与使动螺旋交于一点的线矢量螺旋系,支链中此类螺旋数目至少为2个,一个轴线平行于Z轴方向,另一个轴线平行于Y轴方向,且其轴线相交于一点。
下文分三种情况对主动螺旋的三种类型进行详细讨论。
4.1.1 沿X轴方向的移动副驱动当驱动副为移动副,且移动副轴线平行于X轴方向时,有
$\left\{ \begin{matrix} {{\$}_{a1}}=\left[ 100;000 \right],\text{ }h=0 \\ {{\$}_{q11}}=\left[ 000;100 \right],\text{ }h=\infty \\ \end{matrix} \right.$ | (16) |
根据文献[17]可知,并联机构的运动特征是各支链运动特征的交集,所以并联机构支链必含动平台的运动特征,即该支链连接度至少为3R2T类型,所以支链的连接度有5和6两种,根据支链连接度的不同可依次推导出支链的机构类型,详细的支链一结构如表 1第一类所示。为简化结构和直观分析,设定相邻运动副轴线方向均垂直或平行,其中所出现的4R1T类型的并联机构是以3R2T类型经过线性组合变换所得,变换过程中需注意的是一个转动副和一个移动副的线性组合成一个2R平行子链需具有一定条件:即原支链中存在垂直于该转动副轴线方向的两个移动自由度。具体的螺旋线性变换方法参考文献[19],下文中其他类型变换同理。
4.1.2 绕Y轴方向的转动副驱动当驱动副为转动副,且其轴线平行于Y轴方向时,有
$\left\{ \begin{matrix} {{\$}_{a1}}=\left[ 100;000 \right],\text{ }\$h=0 \\ {{\$}_{q12}}=\left[ 010;{{d}_{12}}0{{f}_{12}} \right],\text{ }\$h=0 \\ \end{matrix} \right.$ | (17) |
当输入副为转动副时,等效于用一个2R平行转动副替代沿X轴的移动驱动,所以此类分支的运动连接度至少可达到5个。其具体支链配置类型如下表 1第二类别所示。
4.1.3 绕Z轴方向的转动副驱动当驱动副为转动副,且其轴线平行于Z轴方向时,有
$\left\{ \begin{matrix} {{\$}_{a1}}=\left[ 100;000 \right],\text{ }\$h=0 \\ {{\$}_{q13}}=\left[ 001;{{d}_{13}}{{e}_{13}}0 \right],\text{ }\$h=0 \\ \end{matrix} \right.$ | (18) |
当输入副为转动副时,相当于用一个2R平行子链替代沿X轴的移动驱动,但由于支链中平行于Z轴的线矢量螺旋至少存在一个,所以可知此类分支的运动连接度最少可以为5个。其具体支链配置类型如下表 1中第三类所示。
表 1为支链一的可能结构类型。需要说明的是,由于本文综合的并联机构的运动特征为三转两移,所以支链的连接度至少为5,又由于机构采用独立支链驱动,所以会有5条支链,为简化机构结构,所以本文中构造的支链均不考虑存在冗余运动副的情况; 且限于篇幅,一类支链只给出一种排列情形,对于改变支链中运动副的排列顺序的情况较为简单,不予一一列出。
驱动类别 | 连接度 | 运动副 | 支链类型 | 数目 |
第一类 | 5 | 3R2T | TXTYRXRYRZ; | 11 |
4R1T | TXRXRYRZ1RZ2; | |||
6 | 3R3T | TXTYTZRXRYRZ; | ||
4R2T | TXTZRX1RX2RYRZ;TXTZRXRZ1RZ2RY;TXTYRX1RX2RYRZ;TXTYRXRY1RY2RZ; | |||
5R1T | TXRX1RX2RX3RYRZ;TXRX1RX2RY1RY2RZ;TXRX1RX2RZ1RZ2RY;TXRXRZ1RZ2RY1RY2; | |||
第二类 | 6 | 4R2T | RY1RY2TYTZRXRZ; | 9 |
5R1T | RY1RY2TZRX1RX2RZ;RY1RY2TZRXRZ1RZ2;RY1RY2TYRX1RX2RZ;RY1RY2RY3TYRXRZ; | |||
6R | RY1RY2RY3RX1RX2RZ;RY1RY2RX1RX2RX3RZ;RY1RY2RY3RXRZ1RZ2;RY1RY2RX1RX2RZ1RZ2; | |||
第三类 | 5 | 4R1T | RZ1RZ2TYRXRY | 11 |
5R | RZ1RZ2RZ3RXRY | |||
6 | 4R2T | RZ1RZ2TXTZRYRX; | ||
5R1T | RZ1RZ2RZ3TZRYRX;RZ1RZ2TZRY1RY2RX;RZ1RZ2TYRY1RY2RX;RZ1RZ2TYRYRX1RX2; | |||
6R | RZ1RZ2RZ3RY1RY2RX;RZ1RZ2RZ3RYRX1RX2;RZ1RZ2RY1RY2RY3RX;RZ1RZ2RY1RY2RX1RX2; |
第二条支链对动平台提供沿Y轴方向的移动输入。由于第二条支链的型综合原理类似于第一条支链的型综合过程,同理可得第二条支链上的使动螺旋和主动螺旋分别为
${{\$}_{a2}}=\left[ 010;000 \right]$ | (19) |
依据上节的分析方法,其主动螺旋有三类:
$\left\{ \begin{matrix} {{\$}_{q21}}=\left[ 000;010 \right],\text{ }\$h=\infty \\ {{\$}_{q22}}=\left[ 100;0{{e}_{22}}{{f}_{22}} \right],\text{ }\$h=0 \\ ~{{\$}_{q23}}=\left[ 001;{{d}_{23}}{{e}_{23}}0 \right],\text{ }\$h=0 \\ \end{matrix} \right.$ | (20) |
根据上节综合原理可得第二条支链具体结构类型见表 2。
驱动类别 | 连接度 | 运动副 | 支链类型 | 数目 |
第一类 | 5 | 3R2T | TYTXRYRXRZ; | 11 |
4R1T | TYRYRXRZ1RZ2; | |||
6 | 3R3T | TYTXTZRYRXRZ; | ||
4R2T | TYTZRY1RY2RXRZ; | |||
TYTZRYRZ1RZ2RX; | ||||
TYTXRY1RY2RXRZ; | ||||
TYTXRYRX1RX2RZ; | ||||
5R1T | TYRY1RY2RY3RXRZ; | |||
TYRY1RY2RX1RX2RZ; | ||||
TYRY1RY2RZ1RZ2RX; | ||||
TYRYRZ1RZ2RX1RX2; | ||||
第二类 | 6 | 4R2T | RX1RX2TXTZRYRZ; | 9 |
5R1T | RX1RX2TZRY1RY2RZ; | |||
RX1RX2TZRYRZ1RZ2; | ||||
RX1RX2RX3TXRYRZ; | ||||
RX1RX2TXRY1RY2RZ; | ||||
6R | RX1RX2RX3RY1RY2RZ; | |||
RX1RX2RY1RY2RY3RZ; | ||||
RX1RX2RX3RYRZ1RZ2; | ||||
RX1RX2RY1RY2RZ1RZ2; | ||||
第三类 | 5 | 4R1T | RZ1RZ2TXRYRX; | 11 |
5R | RZ1RZ2RZ3RYRX; | |||
6 | 4R2T | RZ1RZ2TXTZRYRX; | ||
5R1T | RZ1RZ2RZ3TZRYRX; | |||
RZ1RZ2TZRY1RY2RX; | ||||
RZ1RZ2TYRY1RY2RX; | ||||
RZ1RZ2TYRYRX1RX2; | ||||
6R | RZ1RZ2RZ3RY1RY2RX; | |||
RZ1RZ2RZ3RYRX1RX2; | ||||
RZ1RZ2RY1RY2RY3RX; | ||||
RZ1RZ2RY1RY2RX1RX2; |
第三条分支仅对X轴方向的转动提供输入驱动,其使动螺旋 $a3 的形式为
${{\$}_{a3}}=\left[ 000;100 \right]$ | (21) |
若第二条支链上表示驱动副的驱动螺旋为 $q3=[a3 b3 c3 ; d3 e3 f3] 。由于综合的每条分支都具有三移两转运动特征,所以当驱动螺旋具有Y与Z方向转动分量时,可能会引起动平台具备Y、Z方向的转动自由度,破坏了机构的转动解耦特性,驱动螺旋只能为
${{\$}_{q3}}=\left[ 100;0{{e}_{3}}{{f}_{3}} \right]$ | (22) |
将式(21) 和式(22) 代入式(10) 可得
${{J}_{v}}_{33}={{\$}_{a3}}{}^\circ {{\$}_{q3}}=1$ | (23) |
由式(23) 可知,[Jv]33满足非零条件,所以有
$\left\{ \begin{matrix} {{\$}_{q3}}=\left[ 000;1~00 \right]h=\infty \\ {{\$}_{q3}}=\left[ 001;0{{e}_{3}}{{f}_{3}} \right]h=0 \\ \end{matrix} \right.$ | (24) |
根据上述分析,可得到第三条支链的具体结构如下表 3所示。
连接度 | 运动副 | 支链类型 | 数目 |
5 | 3R2T | RXTXTYRYRZ; | 4 |
4R1T | RXTYRYRZ1RZ2; | ||
RXTXRYRZ1RZ2; | |||
5R | RXRYRZ1RZ2RZ3; | ||
6 | 3R3T | RXTXTYTZRYRZ; | 26 |
4R2T | RXTZTYRZRY1RY2; | ||
RXTZTYRYRZ1RZ2; | |||
RX1RX2TXTZRYRZ; | |||
RXTZTXRYRZ1RZ2; | |||
RX1RX2TXTYRYRZ; | |||
RXTXTYRY1RY2RZ; | |||
5R1T | RX1RX2TZRY1RY2RZ; | ||
RXTZRY1RY2RZ1RZ2; | |||
RX1RX2TYRY1RY2RZ; | |||
RXTYRY1RY2RY3RZ; | |||
RX1RX2TZRYRZ1RZ2; | |||
RXTZRYRZ1RZ2RZ3; | |||
RX1RX2TYRYRZ1RZ2; | |||
RXTYRY1RY2RZ1RZ2; | |||
RX1RX2RX3TXRYRZ; | |||
RX1RX2TXRY1RY2RZ; | |||
RX1RX2TXRYRZ1RZ2; | |||
RXTXRY1RY2RZ1RZ2; | |||
6R | RX1RX2RX3RY1RY2RZ; | ||
RX1RX2RY1RY2RY3RZ; | |||
RX1RX2RY1RY2RZ1RZ2; | |||
RXRY1RY2RY3RZ1RZ2; | |||
RX1RX2RX3RYRZ1RZ2; | |||
RX1RX2RYRZ1RZ2RZ3; | |||
RXRY1RY2RZ1RZ2RZ3; |
第四条支链仅对Y轴方向的转动提供输入驱动。第四条支链的型综合过程类似于第三条支链的型综合过程,同理可得第四条支链上的使动螺旋和主动螺旋分别为
$\left\{ \begin{matrix} {{\$}_{a4}}=\left[ 000;010 \right],\text{ }h=\infty \\ {{\$}_{q4}}=\left[ 010;{{d}_{4}}0{{f}_{4}} \right],\text{ }h=0 \\ \end{matrix} \right.$ | (25) |
根据以上方法给出其支链具体结构类型见表 4。
连接度 | 运动副 | 支链类型 | 数目 |
5 | 3R2T | RYTXTYRXRZ; | 4 |
4R1T |
RYTXRXRZ1RZ2; RYTYRXRZ1RZ2; | ||
5R | RYRXRZ1RZ2RZ3; | ||
6 | 3R3T | RYTXTYTZRXRZ; | 26 |
4R2T |
RY1RY2TYTZRXRZ; RYTYTZRXRZ1RZ2; RYTXTZRX1RX2RZ; RYTXTZRXRZ1RZ2; RY1RY2TXTYRXRZ; RYTXTYRX1RX2RZ; | ||
5R1T |
RY1RY2TZRX1RX2RZ; RY1RY2TZRXRZ1RZ2; RY1RY2RY3TYRXRZ; RY1RY2TYRX1RX2RZ; RYTZRX1RX2RZ1RZ2; RYTZRXRZ1RZ2RZ3; RY1RY2TYRXRZ1RZ2; RYTYRX1RX2RZ1RZ2; RY1RY2TXRX1RX2RZ; RYTXRX1RX2RX3RZ; RY1RY2TXRXRZ1RZ2; RYTXRX1RX2RZ1RZ2; | ||
6R |
RY1RY2RY3RX1RX2RZ; RY1RY2RX1RX2RX3RZ; RY1RY2RX1RX2RZ1RZ2; RYRX1RX2RX3RZ1RZ2; RY1RY2RXRZ1RZ2RZ3; RYRX1RX2RZ1RZ2RZ3; RY1RY2RY3RXRZ1RZ2; |
第五条支链仅对Z轴方向的转动提供驱动输入,第五条支链的综合过程类似于第三、四条支链,以下只做简述,具体原理过程请参看上节。同理可知,第五条支链的使动螺旋和驱动螺旋分别为
$\left\{ \begin{matrix} {{\$}_{a5}}=\left[ 000;001 \right],\text{ }h=\infty \\ {{\$}_{q5}}=\left[ 001;{{d}_{5}}{{e}_{5}}0 \right],\text{ }h=0 \\ \end{matrix} \right.$ | (26) |
根据式(6) ,即可得到除驱动螺旋之外的其他运动螺旋所组成的螺旋系,在此直接在表 5中给出具体的支链结构类型。
连接度 | 运动副 | 支链类型 | 数目 |
5 | 3R2T | RZTXTYRXRY; | 4 |
4R1T |
RZ1RZ2TYRXRY; RZ1RZ2TXRXRY; | ||
5R | RZ1RZ2RZ3RXRY; | ||
6 | 3R3T | RZTXTYTZRXRY; | 26 |
4R2T |
RZ1RZ2TYTZRXRY; RZTYTZRXRY1RY2; RZ1RZ2TXTZRXRY; RZTXTZRX1RX2RY; RZTXTYRX1RX2RY; RZTXTYRXRY1RY2; | ||
5R1T |
RZ1RZ2RZ3TZRXRY; RZ1RZ2TZRX1RX2RY; RZ1RZ2TYRX1RX2RY; RZ1RZ2TYRXRY1RY2; RZ1RZ2TZRXRY1RY2; RZTZRX1RX2RY1RY2; RZTYRX1RX2RY1RY2; RZTYRXRY1RY2RY3; RZ1RZ2TXRX1RX2RY; RZ1RZ2TXRXRY1RY2; RZTXRX1RX2RX3RY; RZTXRX1RX2RY1RY2; | ||
6R |
RZ1RZ2RZ3RX1RX2RY; RZ1RZ2RZ3RXRY1RY2; RZ1RZ2RX1RX2RX3RY; RZ1RZ2RX1RX2RY1RY2; RZ1RZ2RXRY1RY2RY3; RZRX1RX2RX3RY1RY2; RZRX1RX2RY1RY2RY3; |
本文采用基于运动特征的综合方法[21],通过构造五条支链再组合五条分支得到并联机构。
由于本文综合的并联机构具有三维转动特征,所以根据并联机构转动条件:任意两分支需能提供垂直于转动方向的二维移动自由度。所以在选择组合五条支链时,需注意以下准则:
1) 五条支链中只能有1条支链的连接度为5,其余四条支链均需为连接度为6的支链。图 2为根据以上方法得到的一种解耦3T2R并联机构。
2) 对于机构中出现的连接度为5的支链,由于转动特征会改变移动特征的方向,所以在支链中移动副需放在转动副之前,这样支链的约束螺旋系将不会发生改变,也就避免了机构自由度的瞬时性。
图 2中所示并联机构的支链结构分别为TXTYRXRYRZ、RX1RX2TZRY1RY2RZ、RXTZTYRZRY1RY2、RY1RY2TZRX1RX2RZ、RZ1RZ2TYRX1RX2RY,其中固定基座及动平台如图 2中所示,五条支链分别为动平台提供沿x、y轴方向的移动自由度和绕x、y、z轴方向的转动自由度。
如图 2所示,选取五条支链的第一个运动副为输入副,且直接与固定基座相连。定义符号如下:l1为支链一上沿x轴方向表示驱动输入的移动距离; θ1为支链二上沿x轴方向的2R平行子链驱动副的输入; θ2为支链三绕x轴线方向旋转输入的角度; θ3为支链四绕y轴方向旋转输入的角度; θ4为支链五绕z轴方向旋转输入的角度。
坐标系如图 2中所示,假设支链二中与驱动副相连的连杆长为L,初始角度为γ。用沿x轴方向的2R子链替代沿y轴的移动输入,分析如下图 3所示。
由图 3知,驱动副沿y轴方向的移动输入距离y为
$y=Lsin({{\theta }_{1}}+\gamma )-Lsin\text{ }\gamma $ | (27) |
根据以上分析,可知机构输入分别为(l1、θ1、θ2、θ3、θ4),设动平台的对应输出量分别为(x、y、α、β、φ),其中α、β、φ为绕固定轴的RPY角,则根据上述解耦并联机构组成特点,可以得到
$\begin{align} & x={{l}_{1}},y=Lsin\left( {{\theta }_{1}}+\gamma \right)-Lsin\text{ }\gamma \\ & \alpha ={{\theta }_{2}},\beta ={{\theta }_{3}},\phi ={{\theta }_{4}} \\ \end{align}$ | (28) |
对式(28) 两边对时间t求导可得
$\left\{ \begin{array}{*{35}{l}} \dot{x}=l{{\prime }_{1}} \\ \dot{y}=Lcos(\gamma +{{\theta }_{1}})\theta {{\prime }_{1}} \\ \dot{\alpha }=\theta {{\prime }_{2}} \\ \dot{\beta }=\theta {{\prime }_{3}} \\ \dot{\phi }=\theta {{\prime }_{4}} \\ \end{array} \right.$ | (29) |
式(29) 也可以写作:
$\left[ \begin{array}{*{35}{l}} {\dot{x}} \\ {\dot{y}} \\ {\dot{\alpha }} \\ {\dot{\beta }} \\ {\dot{\phi }} \\ \end{array} \right]=\left[ \begin{array}{*{35}{l}} 1 & 0 & 0 & 0 & 0 \\ 0 & Lcos(\gamma +{{\theta }_{1}}) & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 1 \\ \end{array} \right]\left[ \begin{array}{*{35}{l}} l{{\prime }_{1}} \\ \theta {{\prime }_{1}} \\ \theta {{\prime }_{2}} \\ \theta {{\prime }_{3}} \\ \theta {{\prime }_{4}} \\ \end{array} \right]$ | (30) |
可以得到机构的雅可比矩阵为
$J=\left[ \begin{array}{*{35}{l}} 1 & 0 & 0 & 0 & 0 \\ 0 & Lcos(\gamma +{{\theta }_{1}}) & 0 & 0 & 0 \\ 0 & 0 & 1 & 0 & 0 \\ 0 & 0 & 0 & 1 & 0 \\ 0 & 0 & 0 & 0 & 1 \\ \end{array} \right]$ | (31) |
由式(31) 可以看到,在该并联机构的工作空间内,机构的雅可比矩阵为非零对角阵。当cos(γ+θ1)=0时,机构会出现奇异,这是由于采用2R平行转动副作为驱动导致的,当转动角速度方向与移动方向垂直时,会出现奇异位置,这种情况并不是机构不具有解耦性,仅是由转动驱动造成,如果用移动副直接驱动,则不会出现奇异。
6 结论1) 基于螺旋理论,提出了解耦并联机构型综合的一种系统方法,通过分析解耦并联机构雅可比矩阵所要满足的条件,给出了构型原理的具体步骤。
2) 运用该型综合方法,完成了3R2T并联机构的构型综合问题,首先综合3R2T五自由度解耦并联机构各条支链,再根据支链组合原理连接动定平台得到3R2T解耦并联机构。
3) 基于螺旋理论分析了综合得到的一种机构的运动特征,同时求得机构的雅克比矩阵,验证了并联机构的解耦也证明了构型理论正确性。
4) 综合的并联机构具有解耦特点,具有一定的应用前景。
[1] | MENG Xiangdun, GAO Feng, WU Shengfu, et al. Type synthesis of parallel robotic mechanisms: framework and brief review[J]. Mechanism and machine theory, 2014, 78(8): 177–186. |
[2] |
刘玉梅, 曹晓宁, 王秀刚, 等. 基于齐次变换矩阵数值解的6自由度并联机构位姿正解解算[J].
哈尔滨工程大学学报, 2013, 34(7): 894–898.
LIU Yumei, CAO Xiaoning, WANG Xiugang, et al. Forward kinematics of the 6-DOF parallel mechanism based on homogeneous transformation matrix numerical solution[J]. Journal of Harbin Engineering University, 2013, 34(7): 894–898. |
[3] |
冯李航, 张为公, 龚宗洋, 等. Delta系列并联机器人研究进展与现状[J].
机器人, 2014, 36(3): 375–384.
FENG Lihang, ZHANG Weigong, GONG Zongyang, et al. Developments of delta-like parallel manipulators-a review[J]. Robot, 2014, 36(3): 375–384. |
[4] | HERVÉ J M. The mathematical group structure of the set of displacements[J]. Mechanism and machine theory, 1994, 29(1): 73–81. DOI:10.1016/0094-114X(94)90021-3 |
[5] | HUANG Zhen, LI Qinchuan. General methodology for type synthesis of lower-mobility symmetrical parallel manipulators and several novel manipulators[J]. The international journal of robotics research, 2002, 21(2): 131–145. DOI:10.1177/027836402760475342 |
[6] |
杨廷力.
机器人机构拓扑结构学[M]. 北京: 机械工业出版社, 2004 .
YANG Tingli. Topology structure design of robot mechanisms[M]. Beijing: China Machine Press, 2004 . |
[7] |
宫金良, 张彦斐, 高峰. 并联机构的解耦特性[J].
中国机械工程, 2006, 17(14): 1509–1512.
GONG Jinliang, ZHANG Yanfei, GAO Feng. Decoupling characteristics of parallel mechanism[J]. China mechanical engineering, 2006, 17(14): 1509–1512. |
[8] | GLAZUNOV V. Design of decoupled parallel manipulators by means of the theory of screws[J]. Mechanism and machine theory, 2010, 45(2): 239–250. DOI:10.1016/j.mechmachtheory.2009.09.003 |
[9] | CARRICATO M, PARENTI-CASTELLi V. A family of 3-DOF translational parallel manipulators[J]. Journal of mechanical design, 2003, 125(2): 302–307. DOI:10.1115/1.1563635 |
[10] | GOGU G. Structural synthesis of fully-isotropic translational parallel robots via theory of linear transformations[J]. European journal of mechanics-A/solids, 2004, 23(6): 1021–1039. DOI:10.1016/j.euromechsol.2004.08.006 |
[11] | KONG Xianwen, GOSSELIN C M. Type synthesis of input-output decoupled parallel manipulators[J]. Transactions of the Canadian society for mechanical engineering, 2004, 28(2): 185–196. |
[12] |
侯雨雷, 张占叶, 胡鑫喆, 等. 新型两转动自由度完全解耦并联机构及其特性[J].
哈尔滨工业大学学报, 2014, 46(9): 80–85.
HOU Yulei, ZHANG Zhanye, HU Xinzhe, et al. A novel 2-DOF fully decoupled rotational parallel mechanism and its characteristics[J]. Journal of Harbin Institute of Technology, 2014, 46(9): 80–85. |
[13] | LI Weimin, GAO Feng, ZHANG Jianjun. R-CUBE, a decoupled parallel manipulator only with revolute joints[J]. Mechanism and machine theory, 2005, 40(4): 467–473. DOI:10.1016/j.mechmachtheory.2004.09.001 |
[14] | ZHAO Y, LIU J F, HUANG Zhen. A force analysis of a 3-RPS parallel mechanism by using screw theory[J]. Robotica, 2011, 29(7): 959–965. DOI:10.1017/S0263574711000129 |
[15] | ZENG Daxing, HUANG Zhen. Type synthesis of the rotational decoupled parallel mechanism based on screw theory[J]. Science China technological sciences, 2011, 54(4): 998–1004. DOI:10.1007/s11431-010-4239-2 |
[16] | ZENG Daxing, HOU Yulei, LU Wenjuan. Type synthesis method for the translational decoupled parallel mechanism based on screw theory[J]. Journal of Harbin Institute of Technology, 2014, 21(1): 84–91. |
[17] |
张帆, 张丹. 基于支链驱动理论的解耦球面转动并联机构型综合[J].
农业机械学报, 2011, 42(11): 195–199.
ZHANG Fan, ZHANG Dan. Structural synthesis of decoupled spherical parallel mechanism based on driven-chain principle[J]. Transactions of the Chinese society for agricultural machinery, 2011, 42(11): 195–199. |
[18] |
张彦斌, 吴鑫. 完全解耦二移动二转动并联机构结构综合[J].
农业机械学报, 2013, 44(8): 250–255.
ZHANG Yanbin, WU Xin. Structural synthesis of fully-decoupled two-translational and two-rotational parallel mechanisms[J]. Transactions of the Chinese society for agricultural machinery, 2013, 44(8): 250–255. |
[19] | BALL R S. A Treatise on the Theory of Screws[M]. Cambridge: Cambridge University Press, 1900 . |
[20] | CARRICATO M, PARENTI-CASTELLI V. Singularity-free fully-isotropic translational parallel mechanisms[J]. The international journal of robotics research, 2002, 21(2): 161–174. DOI:10.1177/027836402760475360 |
[21] |
高峰, 杨加伦, 葛巧德.
并联机器人型综合的GF集理论[M]. 北京: 科学出版社, 2011 .
GAO Feng, YANG Jialun, GE Qiaode. Type synthesis of parallel mechanisms based on GF set[M]. Beijing: Science Press, 2011 . |