基于RobotStudio 6.08的搭建搬运码垛工作站.docx

《基于RobotStudio 6.08的搭建搬运码垛工作站.docx》由会员分享，可在线阅读，更多相关《基于RobotStudio 6.08的搭建搬运码垛工作站.docx（34页珍藏版）》请在课桌文档上搜索。

1、毕业设计说明书（论文）设计（论文）题目:基于RobotStUdi06.08的搭建搬运码垛工作站业:工业机i人技术目录第1章绪论1.1 设计背景11.2 国内外机器人现状11.3 发展趋势41.4 主要内容5第2堂码垛工作站搭建62.1码垛工作站的组成62.2零部件的选型设计72. 2.1码垛机普人夹具83. 2.2码垛机器人夹具设计84. 2.3码垛机器人夹具的安装及坐标建立92. 3本章小结9第3度仿真系统设计102.1 仿真和离线编程流程103. 2动态组件的设计113.2.1夹具组态设计113.2.2传送带组态设计123.3关联I/O信号123.3.1夹具信号123.3.2传送带信号15

2、3.4本章小结17第4章系统编程与仿真184.1整体I/O信号创建1842工作站逻辑184.3创建目标点204.4程序编制214.41RaPid程序组成214.42程序内容224.5本章小结28结论29致谢30参考文献31摘要工业机器人技术在国内应用越来越广泛，而单一的工业机器人本体不能充分发挥其协同作业的功能，为了解决这一问题,将ABB工业机器人本体与搬运雎元、码垛单元、以及安全单元等外围设备进行集成，实现工业机器人与周围环境的信息交互。本文以机器人码垛工作站为研究对象，进行机器人码垛工作站的设计与仿真。本次设计选用ABB公司研发的Robotstudio软件，利用其进行机泯人码垛工作站的工作

3、过程仿真，对码垛工作站的组成、组件设计、程序编程等进行研究。利用RobOtStUdio的SoIidWorkS模型导入、路程规划、程序编辑罂、工具辅助等功能来提供机器人码垛工作站工作流程方案，为机器人码垛过程提供实验平台和理论依据。本次设计将分为三个部分:码探机器人工作站的构筑;为工作站添加动态效果;仿真路线并依此编写程序。第一部分主要由Kobotstudio自身附带的组件和So1.id1.rorkS建模来进行，第二部分需以活运用Smar1.组件，使机器人的夹具和传送链有动态效果。第三部分需要将工作站的工作方式、系统信号组成与Smart组件关联起来,再编写程序从而实现机罂人的仿真运行。关键字：机

4、器人码垛工作站：虚拟仿真：编程应用第一章绪论11设计背景随着现代工业自动化的推进和发展，机器人在各种工业环境的综合应用也愈加深入。码垛机器人被广泛应用于各种物料运输行业，能够替代大量的人力，在降低成本的同时也大大提尚了生产率,所谓码垛就是将物料按照一定的模式堆码成球，以便使单元化的物垛实现物料的搬运、装卸、运输、存储、等物流活动。在单元化物体的运输和卸载过程中除f散装的物体和液体外，一般的物体都是以码垛的形式进行存储或组装，这样即可使工作站承我更多的单位物体，又为物品的放置节省空间。对于工作站整体来说，仅仅改良机器人的性能是顾此失彼的，本次设计还需要注意到工作站工作的安全性与合理性，这就需耍精

5、细化的各方面分析与设计。对于码垛机器人模拟仿真是基于RobotStudio的。RobotStudio是用于工业机器人仿H的软件，这款软件制作精良、功能强大,它包含了几乎所有ABB机涔人的模型，能筋进行复杂几何体模里的导入、路径规划、碰撞检测、虚拟仿真、离线编程、在线作业等，涵盖/码垛机器人操作的整个周期。利用其Smart组件，可以实现各型号ABB公司工业机器人的码垛。1.2国内外机器人现状欧美在码垛机器人的研究上经过几十年已经不止于机器人本身的性能，而是更简洁、高效的系统设计与新型结构的研发。澳大利亚中央昆士兰.大学的AbdUIMdMazid和Pave1.Dzitac进行了高速玛垛机器人的高效

6、控制配置研发,通过在运行在人机界面触摸屏上的图形应用程序、P1.C程序和执行码垛机或构创造使高速机器人堆垛成为可能的伺服系统。码垛机的伺服系统允许P1.C根据配置数据自动重新配置堆垛机，并控制对货物进给执行码垛功能的机器人.这使得机器人可以同时处理多个盒子，从而实现高速码垛。德国杜伊斯堡-埃森大学的BashirSa1.ah、OmarJaneh,BerndNocheTobiasBruckmann,SaberDannou1.进行了新型绳牵引机器人堆垛机控制体系的仿真设计，介绍了基于创新的线出动SRM的堆垛起重机的基于设计和仿真的评估，描述基本组件，并时系统的机械设计进行了概述“设计允许处理小负教操

7、作的高级控制体系结构.开发方程式，以确定在随机和基于类的存储策略的情况卜，线驱动SRM的单命令周期和双基于RobotStUdi。的机器人码垛工作站虚拟仿真设计研究。在仿真软件方面，国外仿真软件仍占据主流。日本FANuC公司的Roboguide,达索DE1.M1.A界面，ROBCAD界面，这些软件都有较好的普遍应用性，界面简单明了，友好的人机交互等优点，为工业自动化领域机器人虚拟仿我设计提供了优良的方案。我国码垛机器人相关技术研发起步较晚在安全性、可靠性、承教能力方面与发达国家仍有一段差距。随着我国在相关方向上的投入不断加大，在码探机器人技术上的研发也正逐渐被各个研究所、企业所重视。昆明船舶设计

8、研究院与哈尔滨工业大学合作进行的基于DSP运动控制器的拆垛、码垛SCARA机器人研制项目中，李涛、张勇、蔡磊运用水平关节的机械结构形式，以基于PC的开放式DSP多轴运动控制器作为控制系统的核心，采用面向对象的开发模式，自主开发了机器人控制系统和结构，如图11所示。图1-1码垛SCARA机器人珠海格力电器股份有限公司的朱元丰开发/一种基于机器视觉的表针自动码垛系统。为了有效识别表针的位置信息和正反面信息，设计了一种新颖的照明方案。利用送料转盘的半透明特性，在表针待吸取区域的上方和下方分别安装一个组合条光源和一个背光源，通过送料转盘上方组合条光源采集的图像，可以第2页提取表针的几何轮廓特征，结合正

9、反面特征图像和儿何轮廓特征图像，可以确定送料转盘上待吸取区域内每一根表针的位置和正反面信息,然后控制平面关节型机器人臼动吸取表针。在机器人虚拟仿真开发上，清华大学的崔培莲和孙增折过去曾开发了仿真系统PCROBSMi1.是一个适用了7BM-PC及其兼容机的机器人仿真系统，它的主要特色在于具有丰富的机器人控制算法和轨迹规划算法。系统具有良好的用户界而，为用户设计、验证自己的轨迹规划和控制算法提供了方便的环境.如系统提供机器人语言SYA1.、:维示教和一维图显功能.同时为更接近实用，系统还考虑了许多实际因素.系统采用C语言和FORTRAN语言编程，具有模块化结构，可扩充,易移植,如图12所示。H,B

10、A.&示9MWiVttMI个“I6nsiIIag.nTVIefg1.ieS图卜2PCROBSM系统结构图山东理工大学的王功亮、主好臣、李振雨、李家鹏于2017年进行了基于RObotStUdi。的码垛机器人智能工作站仿真研究，利用So1.id-WorkS/Pro-E等三维建模软件对机器人末端吸盘进行了三维实体建模，并导入到RobotStudio,添加了输送链、机器人控制相等部件，从而完成了整个生产线的空间布局;进行了机器人和输送链之间的工作站逻辑关系连接与设定，建立了两者之间的通讯与连接，完成了码垛机器人工作站的仿其，如图13所示。图1-3码垛工作站仿真从目前来看，我国在机器人虚拟仿真开发上仍落

11、后了一些工业发达国家，还需设计自己的工业仿真软件.但随着工业自动化的推进、工业市场对智能仿我的迫切需求,在未来工业机冷人设计制造的应用中，终有天能够站在同样的高度。1.3发展趋势陵者工业机器人自动化的市场竞争日趋激烈，对于各方面的需求也在不断提高。无论是时间还是金钱成本都是需要尽可能的减少.停止机器进行调试意味着要在停止设备生产的情况下进行修改或编程，会大大提高成本。目前常规做法是在设计阶段就对新部件的可实用性和可制造性进行检查。在生产制造的同时进行编程。RobotStudio通过离线编程，可以更合理的安持布局，从而提高精度和安全性。这样就可以让工程师更关注于码垛机湍人的性能与人机交互友好度上

12、，制造出更加有竞争力的货物。近几年来，为增加市场需求,国内技术取得了长足的进步，一大批高校及企业纷纷积极研究开发相关技术，但在国内市场中国机器人占比仅有百分之三十左右，这说明本次设计在性价比、技术含量上仍有不小的差距，本次设计应该在多个方面同时发展，未来的新型技术一定是笑合的、多元的，不止在性镀上，在示教器系统设计、智能感应等方面都会体现一个机器人是否足够先进。目前仍有一些小中型企业仍按照比较原始的人工潦水线方式进行作业，这就造成了效率低下且人工成本高昂的缺点，影响J企业发展.，码码垛机器人不仅操作简维，效率高，而且可以降低成本，大大提高了企业的竞争力。进行智能化改革，采用更加少人多智能的生产

13、模式,将会成为机械生产企业的主流。14主要内容本文以对机器人码垛工作站进行仿真码垛为内容，模拟仿真码垛机器人工作站的工作流程并编程，以此通过Robots1.udio软件对机器人码垛工作站的各个组件机制和相关的设计有更深入的了解。运用Smart组件的设计，为机器人工作站各个相关联的地方创建模块，并对工作方式和路线进行离线编程，实现机器人码垛工作站的虚拟仿真。第章，生要介绍了机器人虚拟仿真设计的主要背景、应用的方向和国内外机器人研究成果以及发屣趋势。第二率，主要讲述了机器人码垛工作站的组成部分，选用了IRB460机器人,进行了机器人夹具设计及安装.第三章,主要介绍了码垛工作站的工作潦程，并依据总流

14、程分别对夹具、传送装置进行了Smart组件的创建，对Smart组件各部分的含义内容进行了概述。第四章，主要介绍了最后编程过程，首先将部件信号与要编程的信号串联，为了编写程序确定关键目标点，介绍Rapid的组成，进行仿真后依照逻辑编写出Rapid程序，并详细介绍程序。第2章码垛工作站搭建2.1码垛工作站组成图2-1码垛工作站码垛机器人工作站如图2T所示由机器人、机器人底座、托盘、控制器、传送带、叉车等组成.其中机器人作为核心可以安装各种工具，用以实现各种功能:托盘用来放置货物；传送带起输送货物的作用，也可以作为信号的发起点：叉车可以将装满r的托盘运走，然后运过来一个新的托盘：机器人底座可以平衡机

15、器人受力点，防止机器人帧斜；机器人控制器是根据指令以及传感信息控制机器人完成定的动作或作业任务的装身：示教罂是种手持式操作装置，用于执行与操作机器人系统有关的许多任务：比如运行程序、操纵机器的微小运动、修改机器人系统程序等。本次设计中的货物为长方体，尺寸为60OminX400EX25Omnb如图2-2所示根据货物的各项数值进行下面的选型。图2-2货物2.2零部件的选型设计IRB460是ABBKobotics的最新一代4轴装盘机器人，其设计特点为:高产能、在高有效载荷卜具备短周期时间、大工作范围以及ABB机涔人的重要特征-超长的正常运行时间。IRB160只有个版本，其处理能力可达110kg,工作

16、范圉2.4米。从机器人底座到机器人工具法兰处的连接，机器人中集成了各种用户连接(如电源、信号、总线信号和一个气源)，如图2-3所示。IRB160是高速运作的四轴多功能工业机器人，能缩短各项作业的节拍时间，提升生产效率。这款紧凑型的4轴机器人到达距离为2.4m,有效荷重110kg；荷重60kg条件下的操作节拍高可达2190次循环/小时(400mm2000mm400m),比类似条件下的竞争货物快约15K图2-3IRfM602.2.1码垛机器人夹具码垛机器人上的夹具分为三种:夹爪式、夹板式和真空吸盘式，夹爪式主要用手速度要求较高的工作，夹板式多用于在重量小、精度要求比较高的作业，真空吸盘式夹具主要针

17、对雄以夹起的货物，比如薄壁曲面的物件。本次设计的货物结构较为简单且重量小，所以选用夹板式夹具。2.2.2码垛机器人夹具设计因优物尺寸为600三x400三x250三,依据此尺寸可以将夹具两边夹板长度定义为180mm,两夹板间距为40Imnh为了和法兰盘相匹配，在顶端设置一个直径200mm,高度70mm的网盘，以此固定后面的内容。为了造出更加合理的夹具模型，应该使用Soi1.dworks进行建模。打开So1.idworks,选择一个战准面绘制夹板型的草图，可以依据上述的简略尺寸进行拉伸增料或除模。完成夹板设计后保存并再打开新的零件绘制界面，将夹具的后端利用逐房的拉伸进行建模，最后利用so1.idw

18、orks的组奘功能进行组装，如图2-4所示。图27夹具2.2.3码垛机器人夹具的安装及坐标建立工业机器人的一端法兰就可以安装各种工具，你可以安装一个自定义的工具模型。但如果不进行特殊处理就直接安装，可能会使外部导入的工具无法达到需耍的朝向，也不会在自定义的工具模型末端生成工具坐标系,会造成仿真的误差从而影晌结果。在导入夹具后隐藏机械聘，选择“捕捉中点并将视角调整到合适的角度，如图2-5所示，选中夹具底部中心，进入该夹具的“修改”界面进行设巴本地原点，参考他标为大地坐标。最后在布局界面将其标签拖动在机器人标签上即可。图2-5拾取原点2. 3本章小结本章将机器人码垛工作站中的各个组件导入，组建了整

19、个工作站。本次设计所建构的工作站属于较为筒单的类型，在生产过程中应实现多台机器人同时运作，这就需要更加精细的布局。对于本次设计，将工作站搭建完毕只是作为后续内容的铺垫，此时的工作站各部件只能手动操控甚至无法实现控制夹具改变姿态的功能。想要工作站实现动态，就需要后续Simirt组件的设计。第3章仿真系统设计3.1仿真和离线编程流程循环开始更制货物货物抵达传送带货物抵达抓取点J传感器发出信号，交物已抵达抓取点货物被运到放置点传感器发出信号，夹具上无货物托盘未满托盘放满结束循环图3-1工作流程图37为码垛工作站系统的工作潦程.打开“信号管理器”，将笑制货物信号巴为“1”，此时进货口收到信号，开始循环

20、，货物落到传送带上，传送带将觉物送到抓取点后传感器传出信号，机器人收到信号将优物送到放置点，放置点放置后夹具上的传感器传递信号，夹具上无货物，机涔人回到抓取点上方，判断托盘是否放满，否则维续循环。机器人码垛工作站按照上述进行。由此可知需要两个传感器：在传送带与夹具上。要定位五个目标点：抓取点正上方面处和将货物放抓取时的位置,、放置点正上方高处和将货物放置时的位置、原点。3. 2动态组件的设计3. 2.1央具组态设计点击建模-Smart组件”创建,个名为SiDartConponent1的smart组件,如图3-2所示，并改名为SCGriPPer,它将包涵接下来的各种功能：添加一个线传感涔（1.i

21、neSensor）组件，在夹具上确定一点，使其能在夹具夹起货物时有所反馈（与之关联信号从0变为1）：添加类型为“动作”的AttaCher组件并设置使夹具能夹起货物；添加类型为“动作”的DeIaCher组件并设置使夹具能放置货物：添加类型为“信号与属性”的1.OgiCGate组件并设置为非门能与动作相关联,即触发该组件定义为非;添加1.ogicS1.atch组件，它能与其他信号关联使一定条件卜运行复位或置位操作，最终效果如图3-3所示。SmartComponent1-;sc.onpp*Xttvwitff1.,0SC_Qripper7M,1.i11iftasifi.Gmwtft4*snVK*MT*

22、tUf1.，-B.0色J9ft.3JnJ1.rt啕杵M1.irwSeruror.4r.2017I7twwtwaeiI5CMSC_InRoocJor*m11iifrt-侬oiwhi9nnd12nifttt.IrtW郡WSidBFf+rBRTiFf关TJN*的MJJ,Ee力*U，H.1.irrHovrh25IN99i于5上11arvSrwor以刈打*Fifi1.o1.v3R(MOTj-Jf?1rf11jHD图3T传送带smart组件3.3关联I/O信号在仿真过程中，可以将smart级件当做可编程操控器,只要将smart组件的I/O信号与机器人的I/O信号串联起来，模拟可编程操控器与ABB机器人或传

23、送装巴之间的数据通信，本次设计只要在总控制器中进行信号的改变即可实现各个装置姿态的改变。3.3.1夹具信号点到属性与通信界面添加连结，如图3-5所示。m三廊对*?XSonsodPArt*z;目悚对，IAttacIwr日怵XB微或信号Chi1.djJ允许讦it由I一主取M图3-5添加连结界面单击“添加连结”，分别添加源对象为1.ineSensor的源属性SenscdparJ目标对象A1.Iacher的目标属性或信号Chi1.d,如表3I所示。入3T夹具照性连结源对象源属性F1.标对软目标属性或信号1.ineSensorSensedpar1.At1.acherChi1.dAttacherChi1.

24、dDetacherChi1.d最终效果如图3-6I1.Jtt目上三三.：ituQi1.dMtidgOi1.dIteteteQiM图3f屈性连结切换到信号与连接选项卡，如图3-7所示.1101/0Signa1.s7X伯骂HR信骂财Digita1.1.n3utD臼动复位:的号名行开始京G,：SV匚仁:_：伯号僧小值大值Ioo.00:Io.00z也过只诲匚陈茶嫌定图3-7添加信号界面单击“添加I/OSignaIS”，分别添加信号类型为Digita1.Input信号名称为diGripper的信号和信号类型为Digita1.OnPUt信号名称为doYacuumOK的信号，如表3-2所示。表32夹具I/O

25、信号信号类型信号名称信号值Digita1.InputdiGripper0IJigi1.a1.OnputdoVacuunOK0点击“添加I/OConnection添加如下表的连接，如表33所示。友3-3夹具1/0连接源对象源属性目标对象目标属性或信号含义SCGripperdiGripper1.ineSensorActivediGrippor置为1时，线传感落开始检测1.ineSensorSensedpartAttacherExecute传感器检测到物体时，Attacher组件开始工作AttacherExecute1.ogicSR1.atchSetAttacher完成安装操作后进行置位操作SC_G

26、ripperdiGripper1.ogicGate(not)InputAdiGripper当前状态发送至逻辑非门进行运算1.ogiCGate(not)OutPutDetacherExecute逻辑非门与Detacher拆除动作相关联DetacherExecute1.ogicSR1.atchReSetDetacher完成拆除工作进行身位1.ogicSR1.atchOUtPUtSC_GripperdoVacuuinOK两者互相关联最终效果如图3-8所示&SCOrtppeefIMnG48图3-8I/O连接3.3.2传送带信号单击“添加连结”，分别添加源对象为Source的源属性Copy4目标对叙切换

27、到信号与连接选项卡，单击“添加OSigna1.s”，分别添加信号类型为Digita1.1.nput信号名称为diStart的信号和信号类型为Digita1.Onput为号名称为doBoxInPos的信号，如表3-4所示。表37传送带1/0信号信号类型信号名称信号值Digita1.InputdiStart0Digita1.OnputdoBoxInPos0点击“添加I/OConneCtion”添加如下表的连接,如表3-5所示。表35传送带I/O连接源对象源属性目标对象目标属性或信号含义SC_InFeederdiStartSourceExecutediStart置为I时触Source复制动作Sour

28、ceExecuteQueueExecute完成发制后，复制品加QUCUeP1.aneSensorSensorOutQueueDeqUeUC面传感馔检测到物体，触发并退出QueueP1.aneSensorSensorOut1.ogicGate(not)InputP1.aneSensoJ检测到物体，输出个信号到1.ogicGate1.ogicGate(not)OutputSourceExecute将两组件相关联P1.aneSensorSensorOutSC_InFeedordo)XInPos将两信号相关联技终效果如图3-10所示16!JISCMF4“tMagg图3-10传送带I/O连接33. 4本

29、章小结本章主要进行Smart组件的创建，在Robotstudio软件中，仅仅手动调整机械姿态并不足够，还需要运用Smar1.组件将各个组件相互关联，能锅协同运作。在本次设计中，夹具能够在感应到夹起货物并传递信号，传送装置能够在感应到货物进入并将其送至抓取点完成/动态效果。第四章系统编程与仿真41整体I/O信号创建上一章将传送装置与夹具分别实现了动态仿真，但仍无法使机器人进行整个码垛过程，这是因为需要额外添加I/O信号将smart组件信号与机器人相关联，此时的I/O信号就相当于模拟P1.c再将程序输入，即可实现整体仿真。仿真应用中，标准I/O板提供常用信号有：数字输入【）1、数字输出【）0、模拟

30、输入AI、模拟输出0和输送链跟踪。本次设计采用DSQC652板，设置地址为10,连接总线为DeviceNet-以下为所设置信号，如表4-1所示。表4-1I/O信号序号信号名称类型地址1di_1.BOxinpos_R输入02dijiazhua输入13doOO_CIampAct输出04dostart输出44. 2工作站逻辑工作站逻辑将Smart组件的输入/输出信号与机器人端的输入/输出信号作信号关战。，实现在虚拟示教器中配置信号运行时机版人进行相应动作。在仿真页面点击工作站逻辑，在点击信号和连接，如图IT所示。图41工作站边辑的信号和连接页面点击“添加I/OCOnneCtiOn”添加如下表的连接,

31、如表4-2所示。表42工作站造辑0连接源对缴源属性目标对象目标属性或信号含义SC_InFeederdoBoxInposSySten24di_1.BOxinposR两信号相关联SyStCm24doOOC1.ampActSC_GripperdiGripper两信号相关联SJGriPPer1.oVacuu11OKSyStem24dijiazhua两信号相关联SyStem24dostartSC_InFeederdistart两信号相关联最终效果如图4-2所示你.IK&rJdoM.C1.n(AnXJriFP*Zjri和外SWrt三4Iijidxau11iiSurt加：HM题图4-2工作站设辑I/O连接4

32、.3创建目标点MoveJ指令是在精度不高的情况下从个点到另个点，路径可以为弧线。Move1.是运动过程中始终为一条直线，MoveC为圆孤运动指令，一般定义三个内容：圆弧的起点终点和弧度，码垛过程中不需要此类型运动。所以从初始点到抓取点上方为MoveJ指令，向卜移动到抓取点为Move1.指令，Move1.拍起，MoveJ移动到放置点上方，Move1.放下并松开夹具，Move1.抬起为次循环。设置一个合适的初始状态，在虚拟示教器中的程序数据中点Eb1.urge1.,在robtarget中创建pHome,将机器人移动到准备开始循环的点,在虚拟示教器里选中PHQme点击编辑里的修改位置，如图4-3所示

33、，以PHOmC为机器人原点.1%E叁S?rctarPick(11509.(定义pP1.c(317aI1.*1.iin1.oud1.oBin1.oud1.vaInIiMid1.o至痴*a图43修改p1.1.11e点在虚拟示教器的robtarget里创建pPick设为抓取点，选择“手动线性”，如图4-4所示，移动机器人.将机港人移动到刚好能夹起货物，虚拟示教器里选中pPick点击编辑里的修改位置。ITQ7jt2k.一J图44手动线性图标在robtarget里创建PP1.aceBase设为放置点,选择“手动线性”移动机器人,将机器人移动到刚好能放置的位理,虚拟示教器里选中PPiCk点击编辑里的修改位

34、包。剩余放置点通过偏移计算进行定位。4.4程序编制4.4.1RaPid程序组成Rapid程序由程序模块和系统模块组成，如图4-5所示，编程模块由各种数据和程序组成，每个模块或整个程序都可以纪制到磁盘和内存盘等设备中，反过来亦可。其中，包含在入门和整体处理的模块被称为主处理执行程序实际执行主过程。系统模块不会随程序一同保存，也就是说对系统模块的任何更新都会影响程序内存中所有的随后被教入的程序。本次设计只利用程序模块构建机器人的程序。图4-5模块页面4.4.2程序内容本次设计可将程序内容分为6个例行程序，分别有各自的作用。第一个程序为主程序，可调用例行程序实现科垛功能.PROCMainOr1.ni

35、tA1.1.;运行MniiA1.1.例行程序setdostart：置位dostartWHI1.ETRUEDOIFbPa1.IetFu1.I=FA1.SETHEN判断bPa1.IetFu1.1.是否为假这个条件是否满足，若满足条件则执行下面程序，不满足条件就跳过rPick:运行rPick例行程序rP1.ace;运行rP1.ace例行程序E1.SEWaitTimc0.3：等待0.3秒S1.op;停止ENDIFENDWHI1.EENDPROC第二个程序为初始化程序，让机器人问到原点。PROCr1.nitA1.1.OpcIUa1Pos:=CRobT(1.oo1.:=tGripper);读取当前机器人位

36、置数据赋值给PActua1.PosPACtUaIPos.trans,z:pHome.trans,z;将pHome的Z轴坐标赋值给PACIUaIPoSMovc1.pctua1.Pos,v500,fine,tGrippcrWObj=wobjO:移动到PActua1.Pos点MoveJpHome,v500,fine,tGripperWObj:=wobjO;移动到pHome点bPa1.IetFu1.1.:=FA1.SE;将bPa1.IetFu1.1.赋值为假nCount:1.;聘赋值为1ResetdoOO_C1.ampAct：更位doGripperResetdostart：发位dostartENDPR

37、OC第3个程序是从传输琏上抓取货物PROCrPick()MoveJOffs(pPick,0,0,300),v2000,z50,tGripperWObj:=objO;移动到PPiCk点正上方Z轴的正方向30Omm处WaitDIdi01_BoxinposK,1：当货物到拾取点Move1.pPick,v500,fine,tGrippcrW0bj:=wobjO：移动到拾取点Setdo00C1.ampAct:芭位抓取信号Move1.Offs(pPick,0,0,300),v500,z50,IGripperW()bj:=wobj;移动到拾取点正上方Z轴300mm处ENDPROC第4个程序是在托盘上放置货物

38、PROCrP1.ace()!,Position;放置点的例行程序MoveJOffS(PPIace,0,0,300),v2000,z50,tGripperW0bj:wobjO：移动到放同点正上方Z轴的正方向300mm处Move1.pP1.ace,v500,fine,tGripperWObj:=wobjO:移动到放罩点WaitTineO.5;等待0.5秒Reset1.00C1.ampAct：更位抓取信号，放卜.货物WaitDIdijiazhua,0：当夹具上没有货物时，执行卜.一条程序Move1.Offs(pP1.ace,0.0,300),v500,z50,tGripperWObj:=wobjO：

39、移动到拾取点正上方Z轴的正方向30011n处rP1.aceRD;运行rP1.aceRD例行程序ENDPROC第5个程序是计算放在托盘上货物的数量PROCrP1.aceRD()IncrnCount：将nCount的值加1IEnCount15TIIEN判断nCount是否大于或等于15这个条件是否满足,若满足条件则执行卜面程序,不满足条件就跳过nCount:=1;将nCount赋值为1bPa1.IetFu1.k=TRUE;将bPa1.IetFu1.1.赋值为真MoveJpHome,V1000,fine,tGripperW0bj:=wobjO;回到pHome点ENDIFENDPRoC第6个程序是计算

40、放置优物的位置PROCrPosition()TESTnCount根据nCount的数值，计算放置位置数据CASE 1:PPIaCe:=ReITooI(PPIaCeBase,100,-500,0Rz:-90);第1个放置位置CASE 2:pP1.ace:=Re1.Too1.(pP1.aceBase,-300,-500,0Rz:=90)：第2个放置位置CASE 3:p1.,1.ace:=ReIToo1.(pP1.aceBase,-700,-500,ORz:-90)：第3个放置位置CASE 4:Pp1.acer=Re1.Too1.(pP1.aceBase,O,O,ORz:=O);第4个放置位置CAS

41、E 5:PpIUCe:=Re1.TOo1.(PP1.aCeBase,-600,0,ORz:=O);第5个放置位设CASE 6:pP1.ace:=ReIToo1(pP1.aceBase,O,O,-250Rz:=0);第6个放宜位置CASE 7:PP1.aCe:=ReITooI(PPIaCeBase,-600,01-250Rz:=0);第7个放置位置CASE 8:pP1.acer=Re1.Too1.(pP1.aceBase,100,-500,-250Rz:-90)：第8个放置位置CASE 9:pP1.ace:=Re1.Too1.(pP1.aceBase,-300,-500,0250Rz:=90)：

42、第9个放置位置CASE 10:pP1.ace:=ReIToo1.(pP1.aceBase,-700,-500,-250Rz=90);第10个放置位置CASE 11:pF,1.ace:=ReIToo1.(pP1.aceBase,100,-500,-500Rz:-90)：第11个放置位置CASE 12:PPIaCe:=ReITOoI(PP1.aCeBase,300,-500,500Rz:-90);第12个放置位置CASE 13:pP1.ace:=Re1.Too1.(pP1.aceBase,700,500,500Rz:=90);第13个放四位置CASE 14:PPIaCe:=Re1.TooI(PPIaCeBase,O.O,-500Rz:=0);第14个放置位置CASE 15:PP1.aCe:=Re1.TOoI(PPIaCeBase,-600,01-500Rz:-0);第15个放置位置ENDTESTENDPROCEM)MoD1.J1.E4.5本章小结本章探讨了点位的创建和程序的编写。在编写程序之前，需要将整个要用的点位进行进行定位，还要通过软件的仿真系统进行包括机械运动的模式、速度、姿态等观察可行型，最后依此编写的程序才能顺利运行。机器人码垛的运动并不发杂，但对于对于精度、效率的要求使其需要进行严格的过程监控在Robotst