双模式可重构并联机构的构型及其在酒盒产线中的应用

2024-01-20 06:12张磊李瑞琴宁峰平柴超崔鑫佳郭文孝
包装工程 2024年1期
关键词:支链并联坐标系

张磊,李瑞琴*,宁峰平,柴超,崔鑫佳,郭文孝,2

双模式可重构并联机构的构型及其在酒盒产线中的应用

张磊1,李瑞琴1*,宁峰平1,柴超1,崔鑫佳1,郭文孝1,2

(1.中北大学 机械工程学院,太原 030051; 2.中国煤炭科工集团太原研究院有限公司,太原 030006)

为实现酒盒生产线上酒盒胶线点胶和酒盒底座清废环节的自动化,提出一种双模式可重构并联机构。基于螺旋理论分析该机构在2种模式下的自由度,利用闭环矢量法和D-H法求得对应模式下的位置逆解,采用数值法求解机构工作空间、灵巧度和转动能力指标,给出该机构的应用实例。该机构在2-URU/RRC模式下具有3T自由度,2-URU/URC模式下具有3T1R自由度,工作空间连续且无空洞,获得2-URU/RRC模式下灵巧度指标分布规律和2-URU/URC模式下动平台转动能力。该机构在2-URU/RRC模式下可满足胶线点胶作业需求,在2-URU/URC模式下可满足底座清废作业需求,提高了酒盒生产线自动化程度。

可重构并联机构;点胶;清废;灵巧度;酒盒生产线

酒包装盒作为酒的配套产品,其市场需求巨大。酒盒点胶是内壁涂胶,要求胶头接近并在酒盒胶线平面移动,需要3T运动模式;底座清废为扭撕底座盲孔处多余的裱纸,要求先绕垂直于底座平面转动,使其与底座分离,并通过三维移动将其运送至废料箱,需要3T1R运动模式。点胶和清废作业重复性大、生产空间小。众所周知,串联机械臂结构简单、工作空间大、定位精度低、稳定性差,主要适用于包装要求低、生产空间充足的场合[1-2]。并联机构具有精度高、刚度大等优点,适用于生产空间狭小的场合[3]。

米文博等[4]提出用于药品装箱和码垛的2-UPR/RSPR并联机构,并分析了工作空间。Anvari等[5]以拾取Delta机器人为研究对象,研究了灵巧度。彭红梅等[6]提出一种生产线搬运分拣的2PRPU并联机构,对其进行了性能分析和优化设计。叶伟等[7]提出一种冗余驱动的3T并联机构,分析了结构尺寸对灵巧度等性能指标的影响。Huang等[8]提出一种具有平行四边形闭环子链的三平移并联机构,对其运动学和工作空间进行了分析。沈惠平等[9]提出一种3T1R的2-(RPa3R)3R并联机构,对其工作空间和转动能力等进行了分析。Zhao等[10]提出了一种3T1R的4PPa-2PaR并联机构,并对其可达工作空间进行了优化设计。

可重构并联机构能够进行构型的变换,具有更强的环境适应能力。Carbonari等[11]通过交替锁定球副中一个转动,实现不同的3-CPU运动配置及可重构。徐帅等[12]提出了一种可重构3-RRR平面并联机构,采用运动副锁合的思想,实现机构在3-RRR模式和3-RPR模式之间转换。Hu等[13]提出了一种可重构并联球副,通过开启和锁定驱动关节,可实现一维定轴转动和一维变轴旋转、二维和三维旋转。Plitea等[14]对Recrob可重构六自由度并联机器人进行了研究,通过将主动关节转换为被动关节实现重构。Chablat等[15]对3-PRPiR并联机器人进行了研究,通过锁定移动副和转动副,使机构在3T模式和4种2T1R模式之间切换。Jia等[16]提出了一种基于变胞万向节的空间变胞四连杆机构,通过调整万向节的轴线位置,机构可以从6个自由度转变为5、4、3个自由度。

针对点胶和清废需要不同运动模式的机构,本文提出一种双模式可重构并联机构,通过运动副锁合,实现3T和3T1R这2种运动模式。机构在2-URU/RRC模式下具有3T的自由度,可应用于酒盒胶线点胶环节;在2-URU/URC模式下具有3T1R的自由度,可应用于酒盒底座清废环节。

1 可重构并联机构构型及自由度分析

1.1 可重构并联机构及可重构运动副的构型分析

可重构并联机构由静平台、动平台、2条URU支链(分别为URU-Ⅰ支链和URU-Ⅱ支链)和可重构支链组成的并联机构。可重构支链由可重构运动副、R副和C副组成,R副轴线和C副轴线相互平行。静平台和动平台为正四边形,静平台上运动副位于所在边中点处,URU支链与动平台相连的运动副位于所在边中点处,该机构三维模型如图1所示。

可重构运动副由转轴Ⅰ、转轴Ⅱ和锁紧件组成,转轴Ⅰ轴线平行于C副轴线,转轴Ⅱ轴线垂直于静平台。可重构运动副有2种运动副模式:当锁紧件锁紧转轴Ⅱ时,其为R副模式,由转轴Ⅰ组成;当锁紧件未锁紧转轴Ⅱ时,其为U副模式,由转轴Ⅰ和转轴Ⅱ组成,如图2所示。可重构支链在RRC支链和URC支链之间转换,使并联机构具有3T和3T1R自由度。

图2 可重构运动副的2种模式

1.2 可重构并联机构自由度分析

在可重构并联机构上建立坐标系,静平台边长为2,动平台边长为2。以静平台几何中心为原点,建立静坐标系-,轴垂直静平台向下,轴平行于13并指向1,轴由右手螺旋定则确定;以动平台几何中心1为原点,建立动坐标系1-111,1轴垂直于动平台平面向下,1轴与C副轴线垂直并指向1,1轴由右手螺旋定则确定。以A(=1, 2, 3)为原点,建立支链坐标系,如图1所示。

URU-Ⅰ支链的螺旋系为:

对式(1)求反螺旋,可得出:

同理可得,URU-Ⅱ支链的反螺旋为沿其支链坐标系2轴方向的约束力偶。

可重构支链的自由度分为2种情况讨论。

当可重构运动副处于R副模式时,RRC支链的运动螺旋为:

对式(3)求反螺旋,可得出:

联合式(2)和式(4),可得到2-URU/RRC模式下的运动螺旋系为:

当可重构运动副处于U副模式时,URC支链的运动螺旋为:

对式(7)求反螺旋,可得出:

联合式(2)和式(7),可得到2-URU/URC模式下的运动螺旋系为:

综上可知,当可重构运动副处于R副模式时,机构具有沿、、方向的移动;当可重构运动副处于U副模式时,机构具有沿、、方向的移动和绕轴的转动。

由上述分析可知,在2-URU/RRC时,机构处于3T运动模式,满足点胶需求;在2-URU/URC时,机构处于3T1R运动模式,满足底座清废需求。

2 可重构并联机构运动学逆解分析

采用封闭矢量法对URU支链进行分析,采用D-H法对可重构支链进行分析。

2.1 URU支链的运动学逆解

动平台中心在静坐标系-下的位置矢量为1=[]T。1i(=1, 2)对应URU支链中与静平台相连的连杆AB(=1, 2)对应的矢量,长度为;2i(=1, 2)分别对应URU支链中与动平台相连的连杆BC(=1, 2)对应的矢量,长度为;A(=1, 2)为静平台相连接U副A(=1, 2)在静坐标系-中的位置矢量,1(=1, 2)为与动平台相连接U副C(=1, 2)在动坐标系1-111中的位置矢量,则:

动坐标系相对于静坐标系的姿态变换矩阵为:

式中:为动平台绕轴的转动角度。

当可重构运动副处于R副模式时,机构自由度为3T,因此=0。

动平台相连接的U副C(=1, 2)在动坐标系1-111中的位置矢量转换到静坐标系-中,其表达式为:

当可重构运动副处于R副模式时,位置矢量C(=1, 2)在静坐标系中的坐标为C1=(+,,)、C2=(,−,);当可重构运动副处于U副模式时,位置矢量C(=1, 2)在静坐标系中的坐标为C1=(+,+,)、C2=(+,−,)。

所以,位置矢量C(=1, 2)可以表示为:

|B|=、|C|=、|C|=l(=1, 2),由余弦定理可得URU支链位置反解,即θ(=1, 2):

2.2 可重构支链的运动学逆解

采用D-H法建立2种模式下支链的坐标系,见图3和图4,相应的D-H参数见表1和表2。参数、、31、32为已知量,参数31、32、33、34、35、3、4为未知量。

图3 RRC支链的D-H坐标系

图4 URC支链的D-H坐标系

表1 RRC支链的D-H参数

Tab.1 D-H parameter of RRC limb

表2 URC支链的D-H参数

Tab.2 D-H parameter of URC limb

根据表1和表2中数据可求得2种模式下,动平台到静平台的变换矩阵为:

机构的欧拉角位姿矩阵可写成:

当可重构运动副处于R副模式时,=0。

坐标变换矩阵与欧拉角位姿矩阵对应位置的元素相等,经过化简计算,可求得该可重构支链的位置逆解:

当可重构运动副处于R副模式时,有:

当可重构运动副处于U副模式时,有:

其中:

3 工作空间分析

工作空间大小和形状关系到机构能否达到预期目标。并联机构初始参数:=800 mm、=200 mm、支链1=700 mm、2=800 mm。URU支链驱动设置为与静平台相连U副中与R副轴线平行的转动,可重构支链驱动副设置为与静平台相连的可重构运动副,角度变化设置范围为[–90°, 90°]。根据并联机构初始参数和位置逆解,求出机构工作空间,见图5。

酒盒内壁尺寸为280 mm×130 mm×113 mm,清废酒盒尺寸为120 mm×120 mm×80 mm。2-URU/RRC模式下工作空间方向的取值在[−300, 300]区间内,方向的取值在[−150, 150]区间内。2-URU/URC模式下工作空间方向的取值在[−500, 220]区间内,方向的取值在[−150, 150]区间内,如图5所示。2种模式下并联机构工作空间均连续,无空洞,包含酒盒胶线点胶和酒盒底座清废所需的工作空间,可以满足胶线点胶和底座清废的作业要求。

4 可重构机构的性能分析

4.1 2-URU/RRC模式下的灵巧度分析

采用局部条件数作为灵巧度的评价指标,其定义如下:

式中:()为雅克比矩阵的条件数,()=||·–1||。CI的取值范围为0≤CI≤1。CI越大,说明其运动学性能越好。

从图6可以看出,在=600 mm时,=0 mm,=150 mm时,机构的灵巧度最大。酒盒放置在传送带中心处,动平台与酒盒一侧平齐,机构向轴正向运动。

4.2 2-URU/URC模式下的转动能力分析

根据生产线环境分析可知,选取=600 mm,分析操作空间内的并联机构的转动能力。经过生产实验,扭撕废料所需的角度为15°时,即可将废料与酒盒底座分离,并联机构在操作空间内转动角度为[18°, 72°],包含扭撕废料所需的转动角度,如图7所示。因此操作空间内的并联机构的转动能力满足扭撕废料的需求。

图5 2种模式下的工作空间

图6 Z=600 mm平面局部灵巧度指标分布

图7 Z=600 mm时平面转动能力指标分布

5 应用实例

酒盒胶线点胶时,胶头沿a轴移动至点胶平面,沿a轴和a轴移动完成点胶,人工需要时间为6~10 s,如图8a所示。酒盒底座清废时,先将废料绕b轴转动,使其脱离,再沿b、b、b轴的三维移动完成清废,人工需要时间为15~20 s,如图8b所示。在食品、医药、电子等包装工程领域,并联机构运行速度、工作效率等远高于人工[17]。文中双模式可重构并联机构,可通过变化运动模式完成点胶和清废,一机多用,效率高于多机协同作业。

图8 酒盒生产线中的人工动作

图9 双模式可重构并联机构在酒盒生产线中的应用

在2-URU/RRC模式下,机构通过控制3个驱动电机实现动平台的三维移动,完成点胶作业,如图9a所示。根据上述的工作空间和灵巧度性能分析,当机构进行点胶时,可将酒盒横向放置在机构动平台的正前方,酒盒一侧长边胶线与一个胶头对齐。

当机构为2-URU/URC模式时,机构通过控制4个驱动电机实现动平台的三维移动和绕轴的转动,完成清废作业,如图9b所示。根据上述的工作空间和转动能力性能分析,当机构进行酒盒底座清废时,可将酒盒放置在机构动平台的正下方。

6 结语

串联机械臂重复精度低,生产空间大,不适用于重复作业、生产空间狭小的酒盒点胶和底座清废场景。本文提出一种可应用于酒盒生产线的双模式可重构并联机构,该机构通过运动副锁合来实现2-URU/RRC和2-URU/URC间切换。应用螺旋理论求解得出2种运动模式下机构分别具有3T和3T1R自由度,通过运动学分析各模式下工作空间,内部连续无空洞,可以满足工作需求。分析2-URU/RRC模式下机构灵巧度和2-URU/URC模式下动平台转动能力,得出2-URU/RRC模式时,胶头向轴正方向运动;2-URU/URC模式时,转动能力可以满足清废需求。结合应用实例,得出该机构在2-URU/RRC模式下可完成自动点胶,在2-URU/URC模式下可完成底座自动清废,具有一机多用的效果,节约了经济成本,提高了酒盒生产线的自动化程度。

[1] 田勇, 李俊霞. 基于模糊神经网络的包装机械臂定位方法研究[J]. 包装工程, 2022, 43(9): 171-175.

TIAN Y, LI J X. Positioning Method of Packaging Mechanical Arm Based on Fuzzy Neural Network[J]. Packaging Engineering, 2022, 43(9): 171-175.

[2] 陈艳芳. 包装机械手轨迹规划和控制系统设计[J]. 包装工程, 2020, 41(23): 236-241.

CHEN Y F. Packaging Manipulator Trajectory Planning and Control System Design[J]. Packaging Engineering, 2020, 41(23): 236-241.

[3] 付瑞玲, 禹春来, 范甜甜. 基于并联机器人的包装分拣系统设计[J]. 包装工程, 2018, 39(11): 204-208.

FU R L, YU C L, FAN T T. Design of Packaging and Sorting System Based on Parallel Robot[J]. Packaging Engineering, 2018, 39(11): 204-208.

[4] 米文博, 马春生, 李瑞琴, 等. 应用于药品包装生产线的2-UPR/RSPR并联机构的工作空间分析[J]. 包装工程, 2021, 42(3): 171-176.

MI W B, MA C S, LI R Q, et al. Workspace of 2-UPR/RSPR Parallel Mechanism Applied to Medicine Packaging Production Line[J]. Packaging Engineering, 2021, 42(3): 171-176.

[5] ANVARI Z, ATAEI P, TALE MASOULEH M. Collision-Free Workspace and Kinetostatic Performances of a 4-DOF Delta Parallel Robot[J]. Journal of the Brazilian Society of Mechanical Sciences and Engineering, 2019, 41(2): 1-7.

[6] 彭红梅, 陈亚, 陆彩满, 等. 新型四自由度3T1R并联机器人机构运动学分析与优化设计[J]. 包装工程, 2022, 43(5): 188-195.

PENG H M, CHEN Y, LU C M, et al. Kinematics Analysis and Optimization Design of a New Four Degree of Freedom 3T1R Parallel Robot Mechanism[J]. Packaging Engineering, 2022, 43(5): 188-195.

[7] 叶伟, 胡利焕, 夏董新, 等. 冗余驱动的三平动并联机构性能分析与优化[J]. 农业机械学报, 2021, 52(11): 421-430.

YE W, HU L H, XIA D X, et al. Performance Analysis and Optimization of Redundantly Actuated Three Translational Parallel Mechanism[J]. Transactions of the Chinese Society for Agricultural Machinery, 2021, 52(11): 421-430.

[8] HUANG Y D, LU Q G, WANG H Z, et al. Kinematics Analysis and Simulation of a Novel 3T Parallel Mechanism[J]. Mathematical Problems in Engineering, 2022, 3424012: 1-12.

[9] 沈惠平, 许可, 杨廷力, 等. 一种零耦合度且运动解耦的新型3T1R并联操作手2-(RPa3R)3R的设计及其运动学[J]. 机械工程学报, 2019, 55(5): 53-64.

SHEN H P, XU K, YANG T L, et al. New 3T1R Parallel Manipulator 2-(RPa3R)3R with Zero Coupling Degree and Partial Decoupling: Design and Kinematics[J]. Journal of Mechanical Engineering, 2019, 55(5): 53-64.

[10] ZHAO J, WU C C, YANG G L, et al. Kinematics Analysis and Workspace Optimization for a 4-DOF 3T1R Parallel Manipulator[J]. Mechanism and Machine Theory, 2022, 167: 1-15.

[11] CARBONARI L, CALLEGARI M, PALMIERI G, et al. A New Class of Reconfigurable Parallel Kinematic Machines[J]. Mechanism and Machine Theory, 2014, 79: 173-183.

[12] 徐帅, 尤晶晶, 叶鹏达, 等. 一种可重构3-RRR平面并联机构及其工作空间分析[J]. 南京航空航天大学学报, 2022, 54(3): 466-472.

XU S, YOU J J, YE P D, et al. A Reconfiguration 3-RRR Planar Parallel Mechanism and Its Workspace Analysis[J]. Journal of Nanjing University of Aeronautics & Astronautics, 2022, 54(3): 466-472.

[13] HU X Y, LIU H Z. Design and Analysis of Full-Configuration Decoupled Actuating Reconfigurable Parallel Spherical Joint[J]. Journal of Mechanical Science and Technology, 2022, 36(2): 933-945.

[14] PLITEA N, LESE D, PISLA D, et al. Structural Design and Kinematics of a New Parallel Reconfigurable Robot[J]. Robotics and Computer-Integrated Manufacturing, 2013, 29(1): 219-235.

[15] CHABLAT D, KONG Xian-wen, ZHANG Cheng-wei. Kinematics, Workspace, and Singularity Analysis of a Parallel Robot With Five Operation Modes[J]. Journal of Mechanisms and Robotics, 2018, 10(3): 1-17.

[16] JIA P, LI D L, ZHANG Y K, et al. A Novel Reconfigurable Parallel Mechanism Constructed with Spatial Metamorphic Four-link Mechanism[J]. Proceedings of the Institution of Mechanical Engineers, Part C: Journal of Mechanical Engineering Science, 2022, 236(8): 4120-4132.

[17] 田涛. 一种高速拾取并联机器人的设计与实现[D]. 大连: 大连理工大学, 2013: 1-7.

TIAN T. Design and Implementation of a High-Speed Pick and Place Parallel Robot[D]. Dalian: Dalian University of Technology, 2013: 1-7.

Configuration of Dual-mode Reconfigurable Parallel Mechanism and Its Application in Wine Box Production Line

ZHANG Lei1, LI Ruiqin1*, NING Fengping1, CHAI Chao1, CUI Xinjia1, GUO Wenxiao1,2

(1. School of Mechanical Engineering, North University of China, Taiyuan 030051, China; 2. China Coal Technology & Engineering Group Taiyuan Research Institute Co., Ltd., Taiyuan 030006, China)

The work aims to propose a dual-mode reconfigurable parallel mechanism to realize automation of the dispensing of the wine box glue line and the scrap-clearing of the wine box base in the wine box production line. The degrees of freedom of the mechanism in two modes were analyzed based on screw theory. The closed-loop vector method and D-H method were used to obtain the inverse solution of the position in the corresponding mode. The numerical method was used to solve the workspace, dexterity and rotation ability indexes of the mechanism. The application example of the mechanism was given. The mechanism had 3T degrees of freedom in 2-URU/RRC mode and 3T1R degrees of freedom in 2-URU/URC mode. The workspace was continuous and there was no hole. The distribution of dexterity index in 2-URU/RRC mode and the rotation ability of moving platform in 2-URU/URC mode were obtained. The mechanism can meet the needs of dispensing operation under 2-URU/RRC mode, and can meet the needs of base scrap-clearing operation under 2-URU/URC mode, which improves the automation degree of wine box production line.

reconfigurable parallel mechanism; dispensing; scrap-clearing; degree of freedom; wine box production line

TB486;TH112

A

1001-3563(2024)01-0201-07

10.19554/j.cnki.1001-3563.2024.01.023

2023-04-03

山西省重点研发计划(202202150401018)

猜你喜欢
支链并联坐标系
识别串、并联电路的方法
解密坐标系中的平移变换
坐标系背后的故事
基于重心坐标系的平面几何证明的探讨
审批由“串联”改“并联”好在哪里?
并联型APF中SVPWM的零矢量分配
一种软开关的交错并联Buck/Boost双向DC/DC变换器
臭氧护理皮支链皮瓣200例观察分析
卵内注射支链氨基酸对鸡胚胎生长发育和孵化时间的影响
3UPS-S并联机构单支链驱动奇异分析