一种自适应垛型码垛工艺方法

2021年6月
第49卷第11期
机床与液压
MACHINETOOL&HYDRAULICS
Jun 2021
Vol 49No 11
DOI:10.3969/j issn 1001-3881 2021 11 011
本文引用格式:彭玲,黄昕,祝润泽,等.一种自适应垛型码垛工艺方法[J].机床与液压,2021,49(11):51-56.
PENGLing,HUANGXin,ZHURunze,etal.Apalletizingprocessmethodwithadaptivestacktype[J].MachineTool&
Hydraulics,2021,49(11):51-56.
收稿日期:2020-07-27
基金项目:广东省中高端工业机器人技术企业重点实验室(2018B030323027)
作者简介:彭玲(1991 ),女,硕士研究生,主要研究方向为机器人软件开发㊂E-mail:zyzgmt@163 com㊂
一种自适应垛型码垛工艺方法
彭玲,黄昕,祝润泽,何炳龙
(广州机械科学研究院有限公司中央研究所,广东广州510700)
摘要:针对当前码垛机器人示教生成垛型过程繁琐且耗时的问题,提出一种自适应垛型生成方法,通过修改物品与垛盘尺寸,拖拽物体,实现任意垛型的摆放㊂该方法能够满足不同尺寸工业产品的垛型生成,具有简单快捷的特点㊂以六自由度工业机器人为研究对象,在Linux+Qt的开发环境下对码垛相关功能进行验证,试验结果表明码垛机器人能够按照既定垛型实现产品的正确摆放㊂
关键词:工业机器人;自适应垛型生成方法;码垛工艺中图分类号:TP242 2
APalletizingProcessMethodwithAdaptiveStackType
PENGLing,HUANGXin,ZHURunze,HEBinglong
(CentralResearchInstitute,GuangzhouMechanicalEngineeringResearchInstituteCo.,Ltd.,
GuangzhouGuangdong510700,China)
Abstract:Aimingatthetediousandtime⁃consumingproblemsofcurrentrobotteachingprocesstogeneratestacktype,anadap⁃
tivestackergenerationmethodwasproposed.Bymodifyingthesizeofitemsandpallet,draggingobjects,theplacementofanystackercouldberealized.Thismethodcanmeetthestackergenerationofindustrialproductswithdifferentsizes,andhasthechara
cteristicsofsimpleandfast.Takingthe6-DOFindustrialrobotastheresearchobject,therelevantpalletizingfunctionswereverifiedbasedon
Linux+Qtdevelopmentenvironment.Theresultshowsthattheproductscanbeplacedcorrectlyaccordingtothegivenpalletizingtype.人脸识别门
Keywords:Industrialrobot;Adaptivestackergenerationmethod;Palletizingtechnology
0㊀前言
近年来,工业机器人行业迅猛发展,同时机器人的应用研究也非常广泛[1沥青电加热器
-2]
㊂目前机器人在焊接㊁码
垛㊁喷涂㊁冲压等领域得到广泛的应用,以机器人代替人工作业的方式不但能够极大地提高工厂的生产效率,更能帮助企业降低成本[3
-5]
㊂在目前的物流搬运
行业,比较常用的是示教再现型机器人㊂这类机器人主要是通过一个计算机控制一个多自由度的机械臂,并在示教的时候存储程序相关信息㊂机器人在工作时将信息读取出来,然后进行运动规划,这样机器人就可以根据用户的示教结果进行重复性动作[6
-8]
㊂然而
对于码垛机器人来说,针对不同的应用场景和项目需要,都需要现场的工程技术人员重新设计示教程序,这其中也必定包含繁琐的示教工作㊂一旦物料系统发生改变,包括物料的数量㊁尺寸和位置等,都需要现场工作人员精心设计示教程序;此外还需要对机器人进行调试,修改其中的参数等㊂这不但增加了现场调
试工程师的时间成本,而且也会增加生产厂商的经济成本,甚至影响工厂的生产效率㊂因此,通过加强对码垛现场垛型的研究,设计出一套能够满足常用码垛方式以及用户可以根据产品尺寸自定义垛型的码垛垛型生成系统就显得尤为重要,这对码垛机器人完成复杂多变的任务具有重要的工程实用价值
[9
-11]
因此,本文作者提出并设计了一种自适应垛型码垛工艺开发方法㊂首先,示教校准垛盘坐标系与工具坐标系;其次,在示教器端垛型设置的界面分别设置垛盘与物品的尺寸,通过拖拽的方式完成垛型排样设置;最后,在控制器端根据设置的垛型计算得到垛型上每一个物体在垛盘上的空间位置,进而完成码垛㊁拆垛㊁进垛㊁出垛的路径规划,最后实现码垛的堆垛或拆垛功能㊂
1㊀码垛工艺结构
在实际应用中货物的垛型是多种多样的,货物的尺寸㊁形状大小等都会影响垛型的设置与码垛的方
式[12
-13]
㊂以往的码垛工艺是通过示教的方式,但是
示教的方式很繁琐,特别是在物品的尺寸以及垛型变化的情况下都会加大操作的难度㊂本文作者所提出的码垛工艺方法是通过标定垛盘坐标系与工具坐标系,在标定后的垛盘上进行拖拽完成垛型排样设置,通过这样的方式可以提高垛型数据的利用率,减少示教的时间与复杂度㊂
1 1㊀垛盘坐标系标定
在实际应用中,物品往往是放置在垛盘上的,通
过标定垛盘坐标系可以很快地计算物品的空间位置㊂垛盘坐标系是属于用户坐标系的标定范畴,用户坐标系采用三点法进行标定[14]㊂为了计算的便利以及垛型的视觉效果,在标定垛盘坐标系时应保证Z轴的正方向是垂直向上的,且X轴的正方向水平向右,此外,根据右手定则可确定Y轴的方向
图1㊀垛盘坐标系标定
垛盘坐标系的标定如图1所示,根据图示的坐标系方向进行用户坐标系的标定㊂
(1)首先将机器人末
端移动到垛盘的平面上示教出坐标原点O;
(2)移动机器人到X轴上的任意一点Px,那么
就可根据已经示教好的原点O以及确定的Px作为X轴的正方向,X轴的单位向量n=(Px-O)/norm(Px-O)㊂(3)移动机器人末端到垛盘上的任意一点Py就可构成XOY平面,用户坐标系在Y轴的单位向量m=(Py-O)/norm(Py-O)㊂Z轴的单位向量a=nˑm,通过O㊁X㊁Y三点标定出垛盘坐标系S,垛盘坐标系S在机器人坐标系的位姿可表示为bases
T,其中base为机
器人基坐标系的表示符号㊂base
sT=nx
mxaxOxnymyayOynzm
azOz00
1éëêêêêêù
û
úúúúú(1)
1 2㊀工具标定
在码垛的实际应用中,一般都会在机器人的末端
安装夹具来完成物品的抓取㊂因此在进行垛型设置之前需要校准工具坐标系㊂
工具坐标系一般采用五点法进行标定[15],工具
末端坐标系T相对于机器人末端法兰盘中心的坐标系E的变换矩阵可表示为ETT,工具末端坐标系T相对于机器人基坐标系B的变换矩阵可表示为BTT,那么坐标系T㊁E㊁B之间变换关系可表示如下:
BET㊃E
TT=B
TT
(2)
首先使用三点确定工具坐标T相对于末端坐标
系E的位置参数,手动移动机器人位置使得工具末端从3个不同的方向指向空间内的一个参考点如图2所示,根据最小二乘法即可得到工具末端相对于机器人末端的位置参数值㊂
接着确定工具坐标的姿态参数如图3所示,在五点法标定工具坐标的时候,将标定工具位置参数第3
个点视作当前工具坐标系的原点,继续手动转动机器人,保证工具的末端指向空间的参考点,得到第4点㊁第5点,确定方向,得到标定坐标系相对于法兰的姿态值
图2㊀工具位置参数校准㊀㊀图3㊀工具姿态参数校准
2 码垛工艺开发
2 1㊀示教器界面开发
在实际应用中,为了使码垛的垛型更加稳固,往
往采用多个不同排样进行交叠的方式摆放㊂在进行排样设置时,根据校准好的垛盘坐标系与用户坐标系,设置好垛盘与物品尺寸,用户即可拖拽旋转物体实现任意角度的摆放进而实现当前排样的设置㊂在完成一个物体的拖拽之后即可获取当前物品中心点在XY平面的坐标,根据物品的高度设置与层数设置即可计算得到物品在用户坐标系下Z方向的大小,
通过旋转图4㊀排样数据结构
角度的设置即可获取物品的姿态㊂单个排样的数据包括:物品在用户坐标系XY平面的绝对
坐标,物品的旋转角度㊂排样的数据存储如图4所示㊂
为了实现排样的交叠,文中是通过设置不同的排样,以循环的方式完成排样的交叠㊂通过设置单次循环层数,分别设置单循环中每一层使用的排样,即可
得到当前设置垛型的每一层所使用的排样类型㊂垛型的结构存储如图5所示
图5㊀垛型结构
25㊃机床与液压第49卷
用户通过示教器界面设置码垛的工艺参数,新建垛型,垛型基本属性设置如图6所示,包括垛的总层数㊁单次循环次数㊁用户号与工具号等基本信息
图6㊀垛型基本参数设置
完成垛型的基本参数设置后,接着进行垛型所使用排样的垛型的设置如图7所示,首先设置好垛盘与物品的尺寸,默认垛盘的左下角的位置为所校准用户的原点位置,也可移动机器人通过示教的方式确定垛盘在XOY平面的位置,在编辑菜单添加物品后在垛盘上拖动物品修改物品在垛盘上的位置,也可通过旋转选项输入任意角度修改物品在垛盘上的摆放角度,依次添加新的物品进行拖拽与旋转,物品上的标号记录的是码垛的顺序,直至完成当前排样垛型的设置㊂以相同的方式完成其他排样的设置
图7㊀垛型设置
在完成所需排样设置之后,接着就是设置单循环中每一层使用的排样与偏置㊁速度比率,如图8所示,通过速度比率的调节设置可以控制进垛路径与出垛路径的速度㊂保存之后就完成了整个垛型的设置
图8㊀排样设置
2 2㊀码垛程序编辑
为了实现物品的整齐摆放与拆解,一般会通过示
教器示教码垛程序,示教器端通过TCP的方式将示教的程序发送给控制器,控制器对示教的文件进行解析执行,实现垛型的路径规划完成码垛工作㊂
码垛程序主要包括运动指令㊁演算指令㊁码垛指令㊁IO指令和控制指令㊂运动指令控制机器人完成物品的定点抓取;演算指令完成码垛㊁拆垛垛满垛空的标志位设置,通过控制指令while循环判断垛空或者垛满完成码垛与拆垛的工作;码垛指令完成码垛进垛出垛规划,控制IO输出的方式控制抓手或是气泵的开关通断㊂通过码垛垛型设置界面完成需要完成的垛型设置㊂
例如根据实际应用,示教实现完成单条生产线单垛的摆放,机器人在流水线的固定位置抓取到物品,之后进行一个标准垛型的摆放㊂具体的示教程序如下所示:
NOP
SETB0000//垛型test垛满标志位
WHILE(B000=0)
MOVJVJ=10PL=0
MOVJVJ=10PL=0//物体抓取点
DOUTOT#(1)ON//打开气泵
TIMERT=0.1//延时100ms,保证到达目标位置
气泵已经打开
MOVJVJ=10PL=0MOVJVJ=10PL=0
PALINMULTtestV=200//进垛,关闭气泵PALOUTMUITtestV=200//出垛
ENDWHILEEND
㊃35㊃第11期彭玲等:一种自适应垛型码垛工艺方法
㊀㊀㊀
2 3㊀码垛工艺实现
码垛工艺包括码垛和拆垛功能㊂码垛即指按照设
置的路径点将物品放入垛盘内,拆垛即指将垛盘里面堆放整齐的物品按照设置的路径点拿出来放在指定的位置㊂可以说码垛跟拆垛是一个互逆的过程㊂文中的码垛工艺不论是码垛功能还是拆垛功能,路径都划分为进垛与出垛㊂比如码垛机器人抓手进入垛盘抓取物品或者抓取物品放入垛盘都统称为进垛,机器人抓手已经在垛盘中码放好物品出来以及进去抓取东西出来都统称为出垛㊂
码跺工艺进垛与出垛路径规划所涉及的4个点分
别是:进入点A1,逼近点B1,目标点C以及回退点B2㊂将码垛分为进垛㊁拆垛两种规划路径,拆垛也分为进垛出垛两种规划路径㊂以下对码垛功能的进垛出
垛路径进行具体说明:码垛进垛:当前点Q➝进入点A➝逼近点B1➝目标点C㊂
如图9所示,机器人抓手首先在点Q抓取到物品后,到达安全过渡点A㊂设置安全过渡点的目的是保证机器人在进垛拆垛的时候不会与其他的物体相撞㊂再进入垛盘逼近点B1,最后机器人进入到目标
点C放下物品,完成单个物品的进垛路径㊂码垛出垛:目标点C➝回退点B2➝进入点A➝当前点Q㊂
如图10所示,机器人在点C放置好物品后,首先进入到回退点B2,然后进入到出垛所要经过的安全过渡点A,最后在点Q完成第二次物品的抓取动作,完成单个物品的出垛路径
图9㊀码垛进垛路径㊀㊀㊀㊀图10㊀码垛出垛路径
文中无论码垛拆垛均以PALIN指令完成进垛的动作㊂PALIN中包含进垛的路径规划,规划中以直线运动到目标点,在机器人运动到目标点时,通过IO的通断来控制抓手的开关或气泵的通断实现物品的抓取与放下㊂以PALOUT指令完成出垛动作,在PAL⁃OUT中包含出垛的路径规划,均以直线运动完成出
垛动作㊂
下面对PALIN㊁PALOUT指令进行相关的参数说明:superboost
PALINMUTITESTV=100/PL=0/LAYER=B[]/I[]/D[]㊀/DUMP=B[]/I[]/D[]
其中:TEST表示设置的垛型;V=100表示进垛速度;PL=0表示进垛平滑等级;LAYER=B[]/I[]/D[]表示当前码垛的层数;DUMP=B[]/I[]/D[]表示当前码垛的垛号㊂PALOUTMULTTESTV=100/PL=0FLAG=
B[]/I[]/D[]
其中:TEST表示设置的垛型;V=100表示进垛速度;PL=0表示进垛平滑等级;FLAG=B[]/I[]/D[]表示标志位㊂
3㊀试验验证
纸巾筒
为了验证文中提出方法的有效性,在校准好垛盘坐标与工具坐标之后,在示教器新建一个垛型test⁃Mat,拖拽形成排样1如图11所示,排样2如图12
所示;根据垛盘实际尺寸与界面显示的像素大小调整像素与实际尺寸的比例尺,由此得到每个物品的中心点在垛盘平面的实际位置㊂排样1㊁排样2在垛盘XOY平面的位置与旋转角度如表1所示,旋转角度为顺时针方向
图11㊀排样1㊀㊀㊀㊀㊀㊀㊀图12㊀排样2
表1㊀排样1㊁排样2数据
货号㊀㊀㊀㊀排样1㊀㊀㊀㊀㊀㊀㊀㊀排样2㊀㊀㊀㊀x/mmy/mmθ/(ʎ)
x/mmy/mmθ/(ʎ)
1132690261302
39269078130365269013529049126903952905266506552906
78
65
091
52
90
㊀㊀根据物品高度以及排样设置所在的层数即可得到物品在垛盘坐标系Z方向的坐标值,根据物品的旋转角度即可得到物品中心点在垛盘坐标系的姿态,旋
转角度逆时针为正方向㊂排样1㊁排样2在垛盘第一层所对应的空间位置如表2所示㊂
45㊃机床与液压第49卷
表2㊀排样1㊁排样2在第一层的空间位置
货号排样1空间位置/
(mm,mm,mm,(ʎ),(ʎ),(ʎ))排样2空间位置/
(mm,mm,mm,(ʎ),(ʎ),(ʎ))
1(13,13,26,-90,0,180)(26,13,26,0,0,180)2(39,13,26,-90,0,180)(78,13,26,0,0,180)3(65,52,26,-90,0,180)(13,52,26,-90,0,180)4(91,52,26,-
90,0,180)(39,52,26,-90,0,180)5(26,52,26,0,0,180)(65,52,26,-90,0,180)6
(78,52,26,0,0,180)码垛
(91,52,26,-90,0,180)
㊀㊀根据校准的工具坐标,即可得到物品中心的最终空间位置㊂
设置总层数为5层,单次循环层数为2,该垛型每一层对应的排样如表3所示,第一㊁二层物品在垛盘坐标系下的进垛路径空间位置点如表4所示,其他层物品的进垛空间位置均是在该层排样下的进垛空间点加上层高㊂
表3㊀垛型层与排样对照
层号排样第1层排样1第2层排样2第3层排样1第4层排样2第5层
排样1
表4㊀进垛路径空间位置
货号进入点空间位置/
(mm,mm,mm,(ʎ),(ʎ),(ʎ))逼近点空间位置/
(mm,mm,mm,(ʎ),(ʎ),(ʎ))目标点空间位置/
(mm,mm,mm,(ʎ),(ʎ),(ʎ))第1层
1(13,13,58 5,-90,0,180)(18,18,57,-90,0,180)(13,13,52,-90,0,180)2
(39,13,58 5,-90,0,180)(44,18,57,-90,0,180)(39,13,52,-90,0,180)3(65,52,58 5,-90,0,180)(70,57,57,-90,0,180)(65,52,52,-90,0,180)4(91,52,58 5,-90,0,180)(96,57,57,-90,0,180)(91,52,52,-90,0,180)5(26,52,58 5,0,0,180)(31,57,57,0,0,180)(26,52,52,0,0,180)6(78,52,58 5,0,0,180)(83,57,57,0,0,180)(78,52,52,0,0,180)第2层
1(26,13,32 5,0,0,180)(31,18,31,0,0,180)(26,13,
26,0,0,180)2(78,13,32 5,0,0,180)(83,18,31,0,0,180)
(78,13,26,0,0,180)
3(13,52,32 5,-90,0,180)(18,57,31,-90,0,180)(13,52,26,-90,0,180)4(39,52,32 5,-90,0,180)(44,57,31,-90,0,180)(39,52,26,-90,0,180)5(65,52,32 5,-90,0,180)(70,57,31,-90,0,180)(65,52,26,-90,0,180)6
热风循环烘箱结构图(91,52,32 5,-90,0,180)
(96,57,31,-90,0,180)(91,52,26,-90,0,180)㊀㊀根据设置的垛型示教生成码垛文件,示教的主要目的是获取物件的抓取点,抓取到物件之后,根据进
垛的路径到目标点后依次通过IO断开的方式放下物品㊂最后的垛型效果如图13所示
图13㊀垛型效果
4㊀结语
提出一种自适应的垛型生成方法,在设置垛型之
前完成垛盘坐标系与工具坐标系的校准,以拖拽的方式完成任意垛型的设置㊂最后基于Linux+Qt的试验平台对本文作者提出的方法进行验证㊂试验结果表明:与传统的在线示教方式相比,提出的方法能够有效降低用户的工作量,提高排样数据的利用率,对复杂垛型有更好的适用性㊂
参考文献:
[1]李红果,刘新乐,徐德众,等.一种多垛型机器人码垛系
统的设计[J].包装工程,2017,38(5):40-44.
LIHG,LIUXL,XUDZ,etal.Designofpalletizingrobot
systemformultiplestacktypes[J].PackagingEngineering,2017,38(5):40-44.
[2]张业鹏,张明.基于PLC与工业机器人的全自动化码垛
系统设计[J].制造业自动化,2015,37(22):108-110.
ZHANGYP,ZHANGM.Automaticpalletizingsystem
basedonPLCandindustrialrobot[J].ManufacturingAuto⁃
㊃55㊃第11期彭玲等:一种自适应垛型码垛工艺方法㊀㊀㊀

本文发布于:2024-09-21 17:55:26,感谢您对本站的认可!

本文链接:https://www.17tex.com/tex/4/339558.html

版权声明:本站内容均来自互联网,仅供演示用,请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系,我们将在24小时内删除。

标签:垛型   码垛   物品   机器人   垛盘   坐标系   设置   完成
留言与评论(共有 0 条评论)
   
验证码:
Copyright ©2019-2024 Comsenz Inc.Powered by © 易纺专利技术学习网 豫ICP备2022007602号 豫公网安备41160202000603 站长QQ:729038198 关于我们 投诉建议