四轴码垛机器人的机构设计及运动分析 5页

第24卷第1期山东科学Vol．24No．12011年2月SHANDONGSCIENCEFeb．2011文章编号:1002-4026(2011)01-0097-05四轴码垛机器人的机构设计及运动分析孙洁，李倩，刘广亮，葛兆斌，李向东(山东省科学院自动化研究所，山东济南250014)摘要:针对物流自动化对高速码垛的需求，基于平衡吊原理设计了一种四轴码垛机器人，并对机器人臂部进行了运动学分析，得到了连杆机构参数优化关系式。该机器人在满负载运动下，垂直方向运动600mm，水平方向运动1600mm，腰部旋转60°时，工作能力可达800回/小时，重复定位精度可达±0．35mm。实验结果证明，机器人能够满足物流自动化的需求。关键词:码垛机器人;机构设计;运动学分析中图分类号:TP242文献标识码:AMechanismdesignandkinematicsanalysisofafouraxisstackingrobotSUNJie，LIQian，LIUGuang-liang，GEZhao-bin，LIXiang-dong(InstituteofAutomation，ShandongAcademyofSciences，Jinan250014，China)Abstract:Wedesignafour-axisbalancehoistbasedpalletizingrobottosatisfytherequirementoflogisticsautomationtorobotpalletizer．Weanalyzethekinematiccharacteristicsforthearmsoftherobotandfurtherobtainanoptimalequationofitslinkagemechanism．Experimentalresultsshowthatsucharobotcansatisfytherequirementoflogisticsautomation．Keywords:stackingrobot;mechanismdesign;kinematicsanalysis码垛是物流自动化技术领域的一门新兴技术，是按照一定模式，将物料堆积成垛，以便使单元化的码垛实现物料的搬运、存储、装卸运输等物流活动。随着企业的集团化以及生产能力的规模化的发展，对码垛机工作能力的要求不断提高，同时，企业生产正在向着多品种少批量的方向发展，这就要求作为后处理设备的［1－2］码垛机，必须具有处理多种产品的能力。目前国外码垛机器人在码垛市场的占有率已经超过90%，绝大多数码垛作业由机器人完成。国外码垛机器人的最大负载能力已经达到1000kg，定位精度±0．08mm，工作循环周期达到1600回/小时。与此相比，国内的码垛技术在处理速度、载荷能力和系统可靠性上还存在［4－6］较大差距。因此开发高性能、低成本、人性化的码垛机器人将有广阔的市场前景。本文主要研究了码垛机器人的机构设计并对连杆机构进行了运动学分析。1机器人总体结构［7－8］我们研制的工业码垛机器人(如图1所示)，其主体机械结构是基于平衡吊原理的连杆机构，具有收稿日期:2010-07-22作者简介:孙洁(1977－)，男，硕士，研究方向为机器人技术、机械设计。＊通讯作者，Email:sunjie@keylab．net\n98山东科学2011年承载力大、稳定性好、结构紧凑、节省能耗等特点。机器人具有4个自由度，2个旋转副和2个移动副，运动由四台交流伺服电机控制，手臂末端的抓手通过绕机座垂直轴的旋转运动(腰部运动)、前大臂的水平运动、后大臂的垂直运动和绕抓手转轴的旋转运动(腕部运动)4种运动的组合完成对物品搬运码垛的3维空间作业。为提高码垛机器人机械系统的控制性能，要求机械传动部件的转动惯量小、摩擦小、阻尼比合理、刚度大，并满足小型、重量轻、高速、低噪声和高可靠性等要求。所以合理地设计驱动方式和机械传动是保证整个机器人伺服控制性能的基本要求［9］。图1工业码垛机器人1．1腰部结构设计Fig．1Palletizingrobot机器人腰部旋转时的转动惯量为l=l1+l2+…ln，式中，l1到ln为运动负荷相对转轴的惯性矩。由上式可知机器人腰部旋转运动克服的负载转动惯量很大，所以在负载和伺服电机之间需要有大传动比的减速装置。考虑到机器人体积结构、传动精度等因素，减速装置采用行星齿轮减速器。伺服电机采用空心轴机构，机械臂的布线从中穿过，当腰部旋转运动时不会产生线缆缠绕。机器人的腰部结构如图2所示。腰部结构为:伺服电机和减速器通过连接法兰固定在机座上，转台轴承的外圈与机座固定，轴承内圈通过连接板与焊接底座相连接。伺服电机减速器驱动连接法兰，进而带动机座实现腰部的旋转运动。转台轴承具有高轴向和径向承载能力、高倾斜刚度的特点，能够满足码垛的现场工作需求。1．2水平垂直运动机构设计水平和垂直运动机构如图3所示。运动机构固定在机座上，由腰部机构带动整体旋转。图中所标注的为x轴运动机构，y轴机构原理同x轴机构。伺服电机通过齿形同步带、同步带轮带动滚珠丝杠旋转，固定在水平滑座的丝杠上的滑块在力的作用下沿直线导轨做水平运动，继而带动机械臂做相应运动。图2腰部结构简图Fig．2Diagramofwaistmechanism图3水平和垂直运动机构简图Fig．3Diagramofhorizontalandverticalmotionmechanism1．3臂部结构设计\n第1期孙洁，等:四轴码垛机器人的机构设计及运动分析99图4机械臂结构简图Fig．4Diagramofrobotarmmechanism机械臂机构由机器人位置机构和机器人腕部姿态调整机构组成，两者相互关联但互不影响，见图4。位置机构是由主臂、前臂、后臂和前后臂连杆组成的四连杆机构，当水平滑座带动前臂做水平运动，垂直滑座带动后臂做垂直运动时，在连杆机构的作用下主臂相应运动。腕部姿态调整机构由两个平行四边形连杆机构和一个三运动副杆(三角支架)组成，主臂、腕部安装座、辅助连杆1和三角支架组成第一个平行四边形连杆机构;前臂、连杆基座、辅助连杆2和三角支架组成第二个平行四边形连杆机构。腕部姿态调整机构使得机器人运动时保持腕部安装座始终水平，即运动时机器人末端执行器的工作位［10］姿保持不变。2机器人臂部运动学分析图5臂部连杆机构简图Fig．5Diagramoflinkmechanism机器人的机械臂的位置机构可简化为图5所示的四连杆机构。图中O为机器人腰部中心，坐标系XO’Y为设定坐标系。C点为机器人x轴丝杠滑座与杆EC，BC的铰接点，在伺服电机的驱动下沿x轴方向作水平运动;A点为机器人y轴丝杠滑座与杆AD的铰接点，在伺服电机的驱动下沿y轴方向作垂直运动。θ为杆EC与x轴的夹角。分析各点位置:xCxC点位置:[]=[](1)y0CxB0B点位置:[]=[](2)yyB\n100山东科学2011年xEx+lCEcosθE点位置:[]=[](3)yElCEsinθxDlADcosθD点位置:[]=[](4)yDy+lADsinθélEFù(xE－xD)+xExêlúFDEF点位置:[]=êú(5)yFêêlEFúú(yE－yD)+yEëlûDE222(xE－xD)+(yF－yD)=lDE(6)由式(3)，(4)，(5)，(6)可解得臂部末端F点的运动方程为:ìlEFlEFxF=(+1)x+［(lCE－lAD)+lCE］cosθïlDElDEïïlEFlEFíyF=－ly+［l(lCE－lAD)+lCE］sinθ(7)DEDEïïl2－x2－y2－(l－l)2DECEADyïθ=arccos()－arcsin()î22222(lCE－lAD)槡x+y槡x+y由式(7)可以看出:机器人臂部连杆机构是2输入2输出的非线性系统，机械臂末端抓手的位置、速度变化相当复杂。当x轴伺服电机驱动点C作水平运动时，末端点F作水平运动的同时，还在因子cosθ影响下在y轴方向运动;当y轴伺服电机驱动点A作垂直运动时，点F作垂直运动的同时，还在因子sinθ影响下在x轴方向运动。这种附带运动容易引起机械臂抓手的振动，加剧机械的磨损。当杆长参数满足条件lEF/lDE·(lCE－lAD)+lCE=0时，式(7)转化为:xF=(lEF/lDE+1)·x{(8)yyF=－lEF/lDE·此时，机器人末端F点的运动为x，y的线性函数，即x轴丝杠的水平运动引起末端F点的水平运动，放大映射系数为lEF/lDE+1;y轴丝杠的垂直运动引起末端F点的垂直运动，放大映射系数为－lEF/lDE，此时机器人运动平稳，振动最小，因此在设计中杆长需要按上述条件确定，且根据x轴、y轴丝杠的行程和腰部的旋转角度可以很方便的确定出机器人手臂末端的工作空间。3试验验证基于上述设计，我们制造了码垛机器人功能样机。在控制上采用工控机+多轴运动控制卡作为硬件平［11］台，以Windows系统为软件平台，采用PTP点位控制方式，实现机器人的码垛作业。样机参数见表1。表1码垛机器人功能样机参数Table1Parametersofstackingrobotprotoype动作范围负载能力动作轴本体重量/kg水平/mm垂直/mm腰部旋转腕部旋转(含抓手)/kg4轴1600800mm330°330°50850经试验，在满负载运动下，垂直方向运动600mm，水平方向运动1600mm，腰部旋转60°时，工作能力可达800回/小时，重复定位精度可达±0．35mm，试验结果表明机器人能够满足生产的需求。\n第1期孙洁，等:四轴码垛机器人的机构设计及运动分析1014结语针对企业现代化生产的需求，设计了一种四自由度搬运机器人。该机器人机械结构设计合理、负载能力大，通过对附加抓手形式的改变可以满足对多种物料的搬运码垛要求。在实体运行中，该机器人动作运行平稳可靠，可广泛应用于物流自动化行业中的物料搬运、分拣等领域，具有广阔的市场前景。参考文献:［1］曾孔庚，王宏庆，丁原彦．高速机器人搬运码垛系统构成及技术特点［J］．机器人技术及应用，2001(4):39－42．［2］胡洪国，高建华，杨汝清．码垛技术综述［J］．组合机床与自动化加工技术，2000(6):7－9．［3］陈辉．浅析全自动包装码垛机器人［J］．科协论坛，2009(10):78－79．［4］李正杰．全自动称重包装机器人码垛成套设备介绍［J］．机器人技术与应用，2007(5):21－23．［5］毕胜．国内外工业机器人的发展现状［J］．机械工程师，2008(7):5－7［6］杨汝清，高建国，胡洪国．高速码垛关键技术研究［J］．高技术通讯，2004，14(2):67－70．［7］闫爱和，焦希润，张素青．平衡吊的运动分析及平衡方法［J］．太原重型机械学院学报，2000(4):295－300．［8］王知行，刘廷荣．机械原理［M］．北京:高等教育出版社，1999．［9］朱世强，王宣银．机器人技术及其应用［M］．杭州:浙江大学出版社，2000．［10］蔡自兴．机器人学［M］．北京:清华大学出版社，2000．［11］杨更更，叶佩青，杨开明，等．基于PC+NC型体系结构的高性能数控系统的研究［J］．机床与液压，2003(3):44－46．