Workspace analysis and structure optimization of parallel robot
-
摘要: 以3-TPT并联机器人作为研究对象,建立了并联机构的运动学逆解和约束结构的运动学正解,给出了连杆和铰链极限约束条件的表达式。然后运用数值法获得工作空间点的集合,并根据并联机器人的实际应用环境,确定有效工作空间的定义,最后以有效工作空间体积最大为目标,基于并联机器人的基础结构尺寸,对连杆长度和约束结构转角范围进行优化,结果表明优化后的有效工作空间体积约是初始体积的1.5倍。Abstract: In this paper, 3-TPT parallel robot is taken as the research object, the inverse kinematics solution of the parallel mechanism and the forward kinematics solution of the constraint structure are established, and the expressions of the limit constraints of the connecting rod and hinge are given. Then, the set of workspace points is obtained by numerical method, and the definition of effective workspace is determined according to the actual application environment of parallel robot. Finally, aiming at the maximum volume of effective workspace, the length of connecting rod and the rotation range of restraint structure are optimized based on the basic structure size of parallel robot. The results show that the optimized volume of effective workspace is about 1.5 times of the initial volume.
-
Keywords:
- parallel robot /
- constraint structure /
- effective workspace /
- structural optimization
-
并联机器人相比于串联机器人具有刚度大、结构稳定紧凑、承载能力强、精度高以及动力性能好等优点[1],因此被逐步应用于工业、医疗等各个领域。
工作空间作为并联机器人末端执行器的工作区域,它是衡量并联机器人性能的重要指标之一[2]。并联机构的运动学研究是求解并联机器人运动特性的基础[3],并联机构的工作空间分析则是运动学研究的主要内容[4]。并联机器人工作空间的获取方法主要有几何法、数值法和解析法。几何法[5]是利用并联机器人的关节的几何关系求得工作空间的边界,几何法很直观,但当机器人关节过多时求解难度就会大幅度增加,必须分组处理。数值法[6]是通过理论计算得到工作空间内的点,通过数值点来表示工作空间,该方法使用较为方便,只需要借助计算机就能求得结果。解析法[7]是利用函数表达式来表示工作空间,通过函数表达式求解工作空间的边界,但由于表达式复杂,十分繁琐,不适用于实际应用。
本文以3-TPT并联机器人作为研究对象,利用数值法求得工作空间范围后分析影响工作空间大小和形状的因素,然后根据实际应用环境定义有效工作空间,分析了杆长和约束结构转角范围对并联机器人有效工作空间的影响,并以有效工作空间最大为目标对并联机器人进行结构优化。
1. 并联机器人的结构
并联机器人结构简图如图1所示,3个动力杆与动静平台通过虎克铰连接,约束结构由2个平行四边形机构内串联组成,各转角皆为转动副,约束结构对运动平台的位姿起限定作用,同时可以增加并联机器人的刚度[8],双十字轴的回转轴线与水平面之间夹角为固定值45°。
2. 并联机器人的位置分析
本文的并联机器人的位置分析即是分析3个动力杆杆长与刀尖点位置之间、约束结构的转动副角度与刀尖点位置之间的关系,为后续工作空间分析提供理论基础。
2.1 并联机构的位置逆解
如图1b所示建立固定坐标系O–XYZ、运动坐标系P–x′y′z′以及末端执行器的坐标系D–xyz,3个坐标系之间的关系如图2所示,固定坐标系O–XYZ和末端执行器的坐标系D–xyz各个轴互相平行。各平台上的铰链点在各自坐标系中的位置如图3所示。
由图1及并联机器人坐标系之间的关系可得,固定坐标系O–XYZ和运动坐标系P–x′y′z′之间的旋转变化矩阵R为
$$ {\boldsymbol{R}} = {\rm{Rot}}(X,45^\circ ){\rm{Rot}}(Y',{\theta _1}) $$ (1) 由此可得在固定坐标系中的3个动力杆的坐标向量:
$$ \left\{ {\begin{gathered} {{{\vec L}_1} = {{\vec b}_1} - {{\vec B}_1} = \left( {\begin{array}{*{20}{c}} { - a\cos {\theta _1} + c\sin {\theta _1} + x + s} \\ {{\raise0.7ex\hbox{${ - \sqrt 2 }$} \mathord{\left/ {\vphantom {{ - \sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}a\sin {\theta _1} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}{l_d} - {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}c\sin {\theta _1} + y + t} \\ {{\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}a\sin {\theta _1} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}{l_d} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}c\sin {\theta _1} + {\textit{z}} - h} \end{array}} \right)} \\ {{{\vec L}_2} = {{\vec b}_2} - {{\vec B}_2} = \left( {\begin{array}{*{20}{c}} {a\cos {\theta _1} + c\sin {\theta _1} + x - s} \\ {{\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}a\sin {\theta _1} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}{l_d} - {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}c{\text{cos}}{\theta _1} + y + t} \\ { - {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}a\sin {\theta _1} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}{l_d} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}c\cos {\theta _1} + {\textit{z}} - h} \end{array}} \right)} \\ {{{\vec L}_3} = {{\vec b}_3} - {{\vec B}_3} = \left( {\begin{array}{*{20}{c}} { - b\sin {\theta _1} + x} \\ {{\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}{l_d} + {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}b{\text{cos}}{\theta _1} + y} \\ {{\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}{l_d} - {\raise0.7ex\hbox{${\sqrt 2 }$} \mathord{\left/ {\vphantom {{\sqrt 2 } 2}}\right.} \lower0.7ex\hbox{$2$}}b\cos {\theta _1} + {\textit{z}}} \end{array}} \right)} \end{gathered}} \right. $$ (2) 所以并联机构的位置逆解为
$$ {L_1} = \left| {{{\vec L}_1}} \right| {L_2} = \left| {{{\vec L}_2}} \right| {L_3} = \left| {{{\vec L}_3}} \right| $$ (3) 2.2 约束结构的位置分析
根据并联机器人的约束结构和动平台与固定平台之间的关系建立如图4所示的约束结构坐标系。
用
${}_j^i{\boldsymbol{T}}$ 表示从坐标系i到坐标系j的旋转变化矩阵,所以从固定坐标系O–XYZ到末端执行器的坐标系D–xyz之间的旋转变化矩阵为$$ {}_D^O{\boldsymbol{T}} = {}_1^O{\boldsymbol{T}}{}_2^1{\boldsymbol{T}}{}_3^2{\boldsymbol{T}}{}_4^3{\boldsymbol{T}}{}_P^4{\boldsymbol{T}}{}_D^P{\boldsymbol{T}} $$ (4) 因为固定坐标系的坐标轴和末端执行器坐标系的坐标轴互相平行,因此求得约束结构的转动副角度与末端执行器位置之间的关系
$$ \left\{\begin{gathered} x=l_{t 1} \cos \left(45^{\circ}-\theta_{2}\right) \sin \theta_{1}+l_{t 2} \sin \left(45^{\circ}-\theta_{3}\right) \sin \theta_{1} \\ y=\frac{\sqrt{2}}{2} l_{t 1}\left(\sin \left(45^{\circ}-\theta_{2}\right)-\cos \left(45^{\circ}-\theta_{2}\right) \cos \theta_{1}\right)-\frac{\sqrt{2}}{2} l_{t 2} \\ \cos\left(45^{\circ}-\theta_{3}\right)-\frac{\sqrt{2}}{2} l_{t 2} \sin \left(45^{\circ}-\theta_{3}\right) \cos \theta_{1}+\frac{\sqrt{2}}{2}\left(t_{2}-t_{1}-l_{d}\right) \\ {\textit{z}}=\frac{\sqrt{2}}{2} l_{t 1}\left(\sin \left(45^{\circ}-\theta_{2}\right)+\cos \left(45^{\circ}-\theta_{2}\right) \cos \theta_{1}\right)-\frac{\sqrt{2}}{2} l_{t 2} \cos \\ \cos\left(45^{\circ}-\theta_{3}\right)+\frac{\sqrt{2}}{2} l_{t 2} \sin \left(45^{\circ}-\theta_{3}\right) \cos \theta_{1}+\frac{\sqrt{2}}{2}\left(t_{2}-t_{1}-l_{d}\right) \end{gathered}\right. $$ (5) 3. 并联机器人的工作空间分析
3.1 工作空间影响因素
机器人工作空间是指机器人末端执行器所能到达的空间范围,本文所研究的3-TPT并联机器人的工作空间受以下几个因素的影响[9-10]:
(1)动力杆长度。动力杆为滚珠丝杠结构,有行程范围限制,用Limin和Limax来表示第i个杆的行程最大范围和最小范围。则动力杆的约束条件表示为
$$ {L_i}_{\min } \leqslant {L_i} \leqslant {L_i}_{\max }\;\;\;i = 1,2,3 $$ (6) (2)虎克铰位置和角度。虎克铰在动静平台的连接位置直接影响动静平台的形状,进而影响并联机器人的工作空间[11]。由于虎克铰存在角度范围限制,它对并联机器人的工作空间范围存在一定的限制,分别用θbi和θBi表示连接动静平台的第i个虎克铰角度,用θbmin、θbmax、θBmin、θBmax表示所允许的最大角度和最小角度,所以虎克铰转角的约束条件为
$$ {\theta _{B\min }} \leqslant {\theta _{Bi}} = \arccos \frac{{{L_i} \cdot {{\vec n}_B}}}{{\left| {{L_i}} \right|}} \leqslant {\theta _{B\max }}\;\;\;i = 1,2,3 $$ (7) $$ {\theta _{b\min }} \leqslant {\theta _{bi}} = \arccos \frac{{{L_i} \cdot {{\vec n}_b}}}{{\left| {{L_i}} \right|}} \leqslant {\theta _{b\max }}\;\;\;\;i = 1,2,3 $$ (8) 式中:
$ {\vec n_B} $ 表示动平台上的虎克铰基座在固定坐标系中的姿势,$ {\vec n_b} $ 表示静平台上的虎克铰基座在固定坐标系中的姿势。(3)约束结构连杆的长度和转角。约束结构的尺寸和各个运动副转角会直接影响并联机器人的工作空间大小,用θimax和θimin表示第i个转角所允许的最大角度和最小角度,则转角变化范围为
$$ {\theta _i}_{\min } \leqslant {\theta _i} \leqslant {\theta _i}_{{\text{max}}}\;\;\;i = 1,2,3 $$ (9) 3.2 工作空间的获取
本文采用搜索法获取并联机器人的工作空间,首先确定约束结构转角的范围,利用约束结构的正解搜索所有满足约束条件的工作空间离散点。
并联机器人初始的结构参数如表1所示,虎克铰的转角范围为[−45°,45°]。
表 1 并联机器人初始参数L1min/mm L1max/mm L2min/mm L2max/mm L3min/mm L3max/mm 300 800 300 800 250 650 θ1min/(°) θ1max/(°) θ2min/(°) θ2max/(°) θ3min/(°) θ3max/(°) −30 30 −15 30 −45 30 利用Matlab求得并联机器人的工作空间如图5所示。
3.3 有效工作空间的定义
由图5可知,求得的并联机器人的工作空间连续且无奇异点,其形状关于XOY面对称。在机器人的实际应用中,我们通常会在求得的工作空间中选用较规整的部分在实际加工中使用,这个较规整的工作空间被称为有效工作空间[12],本文是在工作空间内取一个体积最大的内接球体作为并联机器人的有效工作空间。
所获得的工作空间是由离散点组成,所以在选定有效工作空间前需要先利用式(10)求得中心点M(X,Y,Z)。然后利用Matlab获取工作空间的边界点,利用计算求得边界点和中心点M的距离,取边界点和中心点M之间最小的距离作为有效工作空间的半径,得到的有效工作空间如图6所示,求得其体积约为8.9×106 mm3。
$$ M(X,Y,Z) = \left( {\frac{{\sum\limits_{k = 1}^n {{X_k}} }}{n},\frac{{\sum\limits_{k = 1}^n {{Y_k}} }}{n},\frac{{\sum\limits_{k = 1}^n {{Z_k}} }}{n}} \right) $$ (10) 4. 结构优化
由之前并联机器人工作空间的影响因素可得,工作空间主要受动力杆长度、虎克铰位置和角度、约束结构连杆的长度和转角的影响,受并联机器人的设计要求和整体外部尺寸限制,所以主要优化动力杆长度和约束结构转角的范围。
4.1 动力杆长度的优化
由并联机器人结构可得,动力杆杆1和杆2是互相对称,所以在优化结构时将2个动力杆看作一组进行优化。在优化结构的过程中先保证杆长伸缩范围不变,通过改变最小值来分析有效工作空间的变化,根据分析结果确定杆长的最小值,然后保持杆长最小值不变,通过调整最大杆长来分析有效工作空间的变化情况,根据分析结果确定杆长最大值。
动力杆杆长范围的最小值对并联机器人有效工作空间的影响如图7所示,从图可得,杆1与杆2和杆3的最小值对有效工作空间的影响都呈先增大后减小的趋势。
动力杆杆长范围的最大值对并联机器人有效工作空间的影响如图8所示,杆1与杆2的最大值对有效工作空间的影响整体呈先增大后减小的趋势,杆3的最大值对有效工作空间的影响呈先增大后不变的趋势,说明当杆3杆长范围大于600 mm后就不对并联机器人的有效工作空间产生明显影响。
根据上述分析结果,并联机器人杆长的优化过程如下:首先对杆1和杆2的长度范围进行优化,根据最初设计要求,保持杆1和杆2的伸缩范围为500 mm,改变杆1和杆2的最短杆长。从图可得,并联机器人有效工作空间先增大后减小,当最短杆长为270 mm时有效工作空间最大,所以最短杆长取270 mm。保持杆1和杆2的最短杆长为270 mm,逐渐改变最大杆长。从图可得,并联机器人的有效工作空间整体呈先增大后减小的趋势,当最大杆长为760 mm时有效工作空间最大,所以杆1和杆2的最大杆长取760 mm。
然后对杆3的长度范围进行优化,同样因为最初的设计要求,保持杆3的伸缩范围为500 mm,改变杆3的最短杆长。从图可得,并联机器人有效工作空间先增大后减小,当最短杆长为250 mm时有效工作空间最大,所以最短杆长取250 mm。保持杆3的最短杆长为250 mm,改变最大杆长。从图可得,当最大杆长在小于600 mm时有效工作空间在不断增大,在大于600 mm时有效工作空间大小不发生变化,所以为了并联机器人的结构紧凑性,最大杆长取600 mm。
4.2 约束结构转角范围的优化
优化约束结构转动副转角和优化动力杆的流程相似,先保证转角范围不变,改变转角最小值来分析有效工作空间的变化,根据分析结果确定转角的最小值,然后保持转角最小值不变,通过改变转角最大值分析有效工作空间的变化,根据分析结果确定转角最大值。
约束结构转角范围的最小值对并联机器人有效工作空间的影响如图9所示。由图可知,θ1的最小角度对有效工作空间的影响整体比较平稳,θ2和θ3的最小角度对有效工作空间的影响整体都呈先上升后下降的趋势。
约束结构的转角范围的最大值对并联机器人有效工作空间的影响如图10所示。由图可知,θ1的最大角度越大,并联机器人的有效工作空间反而越小,而随着θ2的最大角度增大,并联机器人的有效工作空间呈先上升后逐渐减小的趋势,θ2的最大角度对有效工作空间的影响整体上呈先上升后下降的趋势。
根据上述分析结果,并联机器人约束结构转角范围的优化过程如下:首先对θ1的转动范围进行优化,根据最初设计要求,θ1的转动范围为60°,保持θ1的变化范围为60°,改变θ1的最小值。从图可得,并联机器人有效工作空间整体呈先增大后减小的趋势,当θ1的最小值为−27°时有效工作空间最大,所以最小值取−27°。保持θ1的最小值为−27°,逐渐改变θ1的最大值。从图可得,并联机器人的有效工作空间整体呈下降趋势,当θ1的最大值为25°时有效工作空间最大,所以最大值取25°。
然后对θ2的转动范围进行优化,根据最初设计要求,θ2的转动范围为45°,保持θ2的变化范围为45°,改变θ2的最小值。从图可得,并联机器人有效工作空间整体呈先增大后减小的趋势,当θ2的最小值为−15°时有效工作空间最大,所以θ2的最小值保持不变取−15°。保持θ2的最小值为−15°,逐渐改变θ2的最大值。从图可得,并联机器人的有效工作空间整体呈先增大后减小的趋势,当θ2的最大值为30°时有效工作空间最大,所以最大值取30°。
最后对θ3的转动范围进行优化,根据最初设计要求,θ3的转动范围为70°,保持θ3的变化范围为70°,改变θ3的最小值。从图可得,并联机器人有效工作空间呈先增大后减小的趋势,当θ3的最小值为−41°时有效工作空间最大,所以θ3的最小值取−41°。保持θ3的最小值为−41°,逐渐改变θ3的最大值,并联机器人的有效工作空间整体呈先增大后减小再增大又减小的趋势,当θ3的最大值为31°时有效工作空间最大,所以最大值取31°。
4.3 优化结果
通过上述的有效工作空间的分析与结构优化,确定优化后并联机器人的结构尺寸:动力杆杆长范围l1∈[270 mm, 760 mm],l2∈[270 mm, 760 mm],l3∈[250 mm, 600 mm];约束结构转动副转角范围θ1∈[−27°, 25°],θ2∈[−15°, 30°],θ3∈[−41°,31°],优化后并联机器人的工作空间如图11所示。通过计算可以得到优化后并联机器人的有效工作空间大小约为1.32×107 mm3,相比初始有效工作空间体积扩大了约1.5倍。
5. 结语
本文以3-TPT并联机器人作为研究对象,通过研究其工作空间,对并联机器人的结构参数进行优化,根据研究结果可以得到以下结论:
(1)利用数值法求出了并联机器人的工作空间。
(2)根据实际应用定义并给出了并联机器人有效工作空间。
(3)分析了并联机器人的连杆长度和约束结构转角范围有效工作空间影响。
(4)通过优化连杆长度和约束结构转角范围实现了有效工作空间的扩大,优化后的有效工作空间约是初始有效工作空间的1.5倍。
-
表 1 并联机器人初始参数
L1min/mm L1max/mm L2min/mm L2max/mm L3min/mm L3max/mm 300 800 300 800 250 650 θ1min/(°) θ1max/(°) θ2min/(°) θ2max/(°) θ3min/(°) θ3max/(°) −30 30 −15 30 −45 30 -
[1] 叶鹏达, 尤晶晶, 仇鑫, 等. 并联机器人运动性能的研究现状及发展趋势[J]. 南京航空航天大学学报, 2020, 52(3): 363-377. DOI: 10.16356/j.1005-2615.2020.03.003 [2] 张曙, Heisel U. 并联运动机床[M]. 北京: 机械工业出版社, 2003. [3] 冯志友, 李永刚, 张策, 等. 并联机器人机构运动与动力分析研究现状及展望[J]. 中国机械工程, 2006, 17(9): 979-984. DOI: 10.3321/j.issn:1004-132X.2006.09.026 [4] 白萌, 高放, 王宁. 航天装配并联机构的工作空间特点及优化设计[J]. 工程机械, 2021, 52(2): 26-31,7. DOI: 10.3969/j.issn.1000-1212.2021.02.007 [5] 何佳唯, 平雪良, 李朝阳, 等. 机器人工作空间求解方法研究及应用[J]. 机械传动, 2015, 39(10): 68-71. DOI: 10.16578/j.issn.1004.2539.2015.10.016 [6] 郭本银, 刘钰, 苗亮. 六自由度微动并联机器人工作空间分析[J]. 长春理工大学学报:自然科学版, 2015, 38(4): 1-5. [7] Jiang Q. Singularity-free workspace of parallel robots[J]. Continuum Mechanics and Thermodynamics, 2015: 1-18.
[8] 王宁. 少自由度并联机床工作空间及运动性能的研究[D]. 沈阳: 沈阳航空航天大学, 2015: 20-32. [9] 葛雍铭, 沈龙, 刘亮. 六自由度并联机构工作空间实验与研究[J]. 计量与测试技术, 2017, 44(11): 1-3. DOI: 10.15988/j.cnki.1004-6941.2017.11.001 [10] Gao Z, Zhang D. Performance analysis mapping, and multi-objective optimization of a hybrid robotic machine tool[J]. IEEE Transactions on Industrial Electronics, 2015, 62(1): 423-433. DOI: 10.1109/TIE.2014.2327008
[11] 郭建烨, 赵亮, 蔡光起. 一种并联机床约束机构参数对工作空间的影响分析[J]. 机械与电子, 2008(5): 10-13. [12] 郭建烨, 刘明哲, 史家顺, 等. 基于约束机构的并联机器人工作空间分析及优化[J]. 机械工程与自动化, 2019, 217(6): 31-34. DOI: 10.3969/j.issn.1672-6413.2019.06.012 -
期刊类型引用(1)
1. 杨智勇,汪浩洋,田望,刘旭. 4UPS-RPS并联机器人工作空间分析及参数优化. 制造业自动化. 2024(10): 91-99 . 百度学术
其他类型引用(7)