工业机器人课件第5章轨迹规划与编程2docx.docx

1、工业机器人课件第5章轨迹规划与编程2docx7.5工业机器人编程机器人语言一一人与机器人的交流一软件部分通用计算机语言:汇编语言、C语言、Pasical语言、Fortran语言等。写起来麻烦,可读性差。机器人的基本操作并不多,如手爪的开闭等,是反复使用的。开发了各种机器人专用语言机器人语言正朝着统标准化发展7.5.1工业机器人编程方式 1示教方式编程示教编成是一项成熟的技术,它是目前大多数工业机器人的 编程方式。示教：操作者必须把机器人终端移动至目标位置,并把此位 置对应的机器人关节角度信息记录进内存储器的过程。再现:当要求复现这些运动时，顺序控制器从内存读出相应 位置,机器人就可重复示教时的

2、轨迹和各种操作。这种方法编制程序是在机器人现场进行的示教方式直接示教(手把手示教):用户使用安装在机器人手臂内的 操纵杆(Joystick ),按给定运动顺序示教动作内容。机器人每一个关节对应着示教盒上的一对按钮,以分别控制该关节正反方向的运动。是目前广泛使用的一种示教编程方式。间接示教（示教盒示教）：利用装在示教盒 上的按钮驱动机器人按需要的顺序进行操作。操作者可以选择在不同坐标系下示教。例如:口关节坐标系(Joint Coordinates) 口直角坐标系(Rectangular Coordinates) 口工具坐标系(Tool Coordinates) 口用户坐标系(User Coord

3、inates)示教编程的优点只需要简单的设备和控制装置即可进行、操作简单,易于掌 握;而且示教再现过程很快，示教之后马上即可应用。缺点:编程占用机器人的作业时间；很难规划复杂的运动轨迹以及准确的直线运动;口难以与传感信息札配合;难以与其它操作同步。2.机器人语言编程用专用的机器人语言来描述机器人的动作轨迹。实现了计算机 编程,并可以引入传感信息，从而提供一个更通用的方法来解 决人一机器人通讯接口问题。3离线编程离线编程是在专门的软件环境支持下用专用或通用程序在离 线情况下进行机器人轨迹规划编程的一种方法。离线编程程 序通过支持软件的解释或编译产生目标程序代码,最后生成 机器人路径规划数据。7.

4、6.2 MOTOMAN机器人编程语言机器人一般采用插补的方式进行运动控制,主要有关节插补、 直线插补、圆弧插补和自由曲线插补。1MOVJ关节插补:在机器人未规定采取何种轨迹运动时, 使用关节插补,以最高速度的百分比来表示再现速度,关节插 补的效率最高;2MOVL直线插补:机器人以直线轨迹运动，缺省单位为 cm/mino直线插补常被用于焊接区间等的作业区间,且机器人在移动过程中自动改变手腕位置；3MOVC圆弧插补:机器人沿着用圆弧插补示教的三个程 序点执行圆弧轨迹运动,再现速度的设定与直线插补相同；4MOVS自由曲线插补:对于有不规则形状的曲线，使用自 由曲线插补，再现速度的设定与直线插补相同；

5、示教焊接工件图举例行命 令内容说明0000NOP程疗;开始0001MOVJ VJ=25.00移到待机位置 程序点10002MOVJ VJ=25.00移到焊接开始位置附近 程序点20003MOVJ VJ=12.5移到焊接开始位置 程序点30004ARCON焊接开始0005MOVL V=50移到焊接结束位置 程序点40006ARCOF焊接结束0007MOVJ VJ=25.00移到不碰触工件和夹具的位置 程序点50008MOVJ VJ=25.00移到待机位置 程序点60009END程序结束机械工业出版社China Machine Press项目3弧焊机器人示教编程弧焊机器人焊接时是按照事先编辑好的程

6、序来进行的，这个程序一般是由操作人员按照焊缝 形状示教机器人并记录运动轨迹而形成的。机器人的程序由主程序、子程序及程序数据构 成。在一个完整的应用程序中，一般只有一个 主程序，而子程序可以是一个，也可以是多个。机械工业出版社 China Machine Press【学习目标】知识目标1.掌握机器人各轴的运动规律；2.掌握弧焊机器人系统中各部分的功能；3.熟悉示教器结构及操作界面与按键功能。技能目标1.能使用示教器操纵杆熟练控制机器人各轴的 运动；2.能使用示教器快速找到并打开所需要选项。【知识准备】一、示教与再现 “示教”就是机器人学习的过程，在这个过程 中，操作者要手把手教会机器人做某些动作

7、， 机器人的控制系统会以程序的形式将其记忆下 来。机器人按照示教时记忆下来的程序展现这些动 作，就是“再现”过程。示教再现机器人的工作原理如图3-1所示。机械工业岀版社China Machine Press三、编程指令及应用 1.基本运动指令及其应用常用基本运动指令有：MoveL、MoveJ、MoveCMoveL：直线运动。 MoveJ：关节轴运动。 B MoveC：圆周运动。 (1)直线运动指令的应用直线由起点和终点确定，因此在机器人的运动路径为直 线时使用直线运动指令MoveL,只需示教确定运动路径 的起点和终点。例如，MoveL p1, v100, z10, tooll ；（直线运动 起

8、始点程序语句）p1:目标位置。V100：机器人运行速度。修改方法：将光标移至速度数据处，回车，进入窗口；选择 所需速度。Z10：转弯区尺寸。修改方法：将光标移至转弯区尺寸数据处，回车，进入窗口; 选择所需转弯区尺寸，也可以进行自定义。toon:工具坐标。小贴士：转弯区尺寸fine指机器人TCP达到目标点（见图3-3中的巳 点），在目标点速度降为零。机器人动作有停顿， 焊接编程时，必须用fine参数。 zone指机器人TCP不达到目标点，而是在距离目 标点一定长度（通过编程确定，如z10）处圆滑 绕过目标点，如图3-3中的片点。机械工业出版社China Machine Press图33转弯区尺寸

9、例使机器人沿长100mm、宽50mm的长方形 路径运动采用offs函数进行精确确定运动路径的准确数值。机器人的运动路径如图3-4所示，机器人从起始点P1, 经过P2、P3、P4点，回到起始点P1。10050P?图34长方形路径)机械工业出版社 :China Machine PressI为了精确确定p1、p2、p3、p4点,可以采用offs函数， 通过确定参变量的方法建行点的精确定位。offs (p, x, y, z)代表一个离p1点X轴偏差量为X, Y 轴偏差量为y, Z轴偏差量为z的点。将光标移至目标点，按“Enter”键，选择Func,采用切 换键选择所用函数，并输入数值。如P3点程序语句

10、为:MoveL Offs(P1, 100, 50, 0),V100,fine,tool1L与z轴距离 与Y轴距离 与X轴距离 起始点机器人长方形路径的程序如下：MoveL OffsPI ,V100,fine,tool1 P1MoveL Offs(P1, 100, 0, 0),V100,fine,tool1 P2MoveL Offs(P1, 100, 50, 0),V100,fine,tool1 P3MoveL Offs(P1,0, 50, 0),V100,fine,tool1 P4MoveL OffsPI ,V100,fine,tool1 P1 (2)圆弧运动指令的应用圆弧由起点、中点和终点三

11、点确定，使用圆弧运 动指令MoveC,需要示教确定运动路径的起点、 中点和终点。圆弧运动路径如图35所示。图35圆弧运动路径P2起点为P0,也就是机器人的原始位置，使用 MoveC指令会自动显示需要确定的另外两点， 即中点和终点，程序语句如下： MoveC p1, p2, v100, z1, tool1与直线运动指令MoveL样，也可以使用offs函 数精确定义运动路径。例2：如图36所示，令机器人沿圆心为P点，半径为的圆运动:图36整圆路径程序如下:MoveJ p, v500, z1, tooll ；0, 0) , offs (p，-80, 0, 0),MoveL offs (p, 80，0

12、, 0)，v500, z1, tooll ； MoveC offs (p, 0, v500, z1, tooll ； MoveC offs (p，0,80, 0)，offs (p，0,0,v500, z1, tooll ； MoveJp, v500, z1, tooll2.输入输出指令Do指机器人输出信号，di指输入机器人信号输入输出信号有两种状态：“1”为接通； “0”为断开。1）设置输岀信号指令Set do12）复位输出信号指令 Reset do13）输出脉冲信号指令 PulseDO do1 3通信指令（人机对话） 1）清屏指令TPErase 2）写屏指令 TPWrite String其中

13、String在示教器显示屏上显示的字符串。每 一个写屏指令最多可显示80个字符。 4.程序流程指令判断执行指令IF循环执行指令WHILE循环指令运行时，机器人循环直到不满足判断条件后，才 跳出循环指令，执行后面的指令。 5.机器人停止指令 Stop指令：机器人停止运行，软停止指令, 直接止下一旬指令启动机噩人； Exit指令：机器人停止运行，并且复位整 个运行程序，将程序指针移至主程序第一 行。下次运行程序时，机器人程序必须从 头开始。6.赋值指令Date : = ValueDate：指被赋值的数据Value：指该数据被赋予的值。 7 等待指令iTAl WaitTime Time等待指令是让机

14、器人运行到该程序是等待一段时间 （Time机器人等待的时间）。四、新建与加载程序新建与加载一个程序的步骤如下: (1)在主菜单下，选择程序编辑器;(2)选择任务与程序；(3)若创建新程序，按新建，然后打开软件盘对程 JSSix負若编辑已有程序，则选加载程序，显示(4)石叟索结果中选择需要的程序，按确认，程序 被加载，如图3-7所示。为了给新程序腾出空间，可 以先删赊先前加载的卡呈序。A IRB_140(SEVST-L-0001641)ManualMotors OffStopped (Speed 100%)V Testprogram in fviAIN/MainModule/mainRow 4

15、of 11 row(s)Tasks and ProgramsModulesRoutinesMODULE MainModule PROC main ()MoveL * r vlOOO z finer too10;MoveLMoveLMoveLENDPROC*r vlOOOr J vlOOOr*r vlOOOrtoolO；fine rfine F toolO;fine,toolO；ENDMODULEAdd Instruct ionEdit 、. ModifyDEg positionMAIN：-MainModV uitfl z1图37机器人程序例行程序有不同的语句组成，如运动指令， 等待指令等。每句

16、指令又由不同的变量组成，变 量视它们自己的类型，可改变或省略。程序中各指令的含义如图3-8所示。A 直线运动指 令名称ManualIRB_140(SEVSI-L (J0U164 1)Motors Off stopped (speed iou%)V lestproQram in MAI N/MainMod e? m ainRew 4 of 11 row(s)Tasks and ProgramsModulesRoutinesB 点位被隐藏 的数值MODULE MainModulePROC main (G可定义的运 动速度D 可定义的运 动点类型（精 确点）E 有效工具* II viod7 tool

17、!mov&L *viodp z f nx tooll4oveL * ND PRO 1vioabrz 七 ooljMoveL 土卩 vlOOO z fine, toolO;A B C D EAdd InstructionEdit *Debug亠呷Position* MAIN: ndimtri uUwENDMODULEf I如图38机器人程序中指令含义 （1）调节运行速度在开始运行程序前，为了保证 操作人员和设备的安全，应将 机器人的运动速度调整到75%。 速慶调节方珪如下：口 1）按快捷键； 2）按速度模式键，显示如图3- 9所示的快捷速度调节按钮； 3）将速度调整为75%或50%； 4）按快捷

18、菜单键关闭窗口。Speed100%-1 % + 1 %-5 96 + 5 %25 % 50 % 100 %图39快捷速度调节 （2）运行程序运行刚才打开的程序，先用手动低速，单步执行，再连续执 行。运行时是从程序指针指向的程序语句开始，图30的 指示的即为程序指针。运行步骤如下：1）将机器人切换至手动模式2）按住示教器上的使能键匚3）按单步向前或单步向后，单步执行程序。执彳亍完一句即 停止。ABBManual Motors effIRE_L4U StVSr-L-CDD 1641) Stopped (Speed iaoh)ILX 丿打 iBstpruyi am in MAlN/Mair 1Mdc

19、iiife/mainTastes and Programs Modkites Row 4 of 11 row (s)Routines MODULE MainModulePROC main ()MoveL * f vlOOO f fine 七oolO;MoveL *MoveL *MoveL *LOGvioao vlOOO z vlOOO,fine r fine t f neftoolO; toolO; fcoolO:ENDMODULEAddInstructionr. MAIN!iilaEditDebugModifyPosition图310程序指针(2)按OK,关闭对话框，示教器上显示生产窗口，女

20、口图312所示；MODULE MainModulePROC main()MoveLMoveLMoveLMoveLENDPROC*r vlOOO,*r vlOOO,*r vlOOOr*r vlOOO,f iner f iner fine r f iner七oolO; 七oolO; toolO; 七oolO;il n AutoMotors OffIRB_14O (SE VST-L-0001641)Stopped (Speed 1009)拓 Production Window: Test program in MAIN/MainModule/ mainRow 2 to 12 of 11ENDMODU

21、LEFile 厶Edit 沁Y Position才 Productio1 - _图312机器人自动运行时的生产窗口(3)按马达上电/失电按钮激活电机；(4)按连续运行键开始执行程序；(5)按停止键停止程序；(6)插入钥匙，运转模式返回手动状态。7.7工业机器人离线编程随着机器人学和计算机技术的不断发展,回前已形成了高度 自动化的生产系统。这些系统和CAD / CAM技术的结合,其 发展已形成了不可避兔的趋势，这就是所谓的CAD/CAM / ROBOTICS -体化。在这样的一体化的系统中，由于机器人工作环境的复杂性, 对机器人及其工作环境乃至生产过程的计算机仿真是必不可少 的。机器人仿真系统的

22、住务,就是在不接触实际机器人及其工 作环境的情况下,通过图形技求,提供一个和机器人进行交互 作用的虚拟环境。与在变线示教编程相比，离线编程系统具有如下优点：(1)减少机器人不工作的时间,当对下一个任务进行编 程时,机器人可仍在生产线上工作。(2 )使编程者远离危险的工作环境。(3)使用范围广,离线编程系统可以对各种机器人进行编 程。(4 )便于和CAD / CAM系统结合,做到CAD/CAM / ROBOTICS 体化。(5)可使用高级计算机编程语言对复杂任务进行编程。(6 )便于修改机器人程序。完整的机器人离线编程系统包括用户接口机器人系统的三维几何建模运动学计算轨迹规划三维图形动态仿真通讯及后处理、误差的校正等。用户接口 (user interface J文件据代码生成编辑语袪1分析机滞人编程运幼学轨迹正反解规划运动学P动生成厉处理通讯接口几何三维图形动画建棋i快速牛成技术机器人运动仿真3控制柜机器人离线编程系统的结构框图图15-17印制电路板焊楼过程的图形仿真谢谢观看