T-02-O-M-启动机器人自动搬运的作业任务概要

1、项目 1.2 启动机器人自动搬运的作业任务 （基于示教盒 + 控制箱）一、项目目的通过本次项目的知识学习和实践操作训练，拟达到以下三大目标：1、知识目标（ 1）熟知工业机器人控制箱面板的构成、功能及其操作方法；（2）熟知工业机器人程序的基本构成及示教盒编程方法；（3）熟知工业机器人程序的单步调试、位置示教方法；（4）熟知工业机器人程序自动运行的操作方法及注意事项；2、技能目标（1）熟练地通过机器人示教盒创建机器人程序文件，并输入已知的机器人程序指令；（2）熟练地通过示教盒为程序指令中的位置变量进行位置示教；（3）正确地通过控制箱启动机器人程序，执行自动作业任务；（4）会排除一般报警故障。3、素

2、质目标（1）形成操作谨慎、安全作业的职业忧患意识；（2）培养共同讨论、相互配合的团队合作精神；（3）养成认真负责、坚守岗位的岗位工作态度；二、项目引入与分析在上一次项目中， 已经讨论了如何使用示教盒来手动控制机器人完成搬运物体的操作任 务。但这不是工业机器人的最终工业用途，而应该是：按照作业任务要求， 沿着所有目标空 间位置和姿态自动地完成一系列的动作， 并重复循环地执行。 本次项目就是围绕如何启动机 器人自动作业任务的课题而展开相关知识的学习和操作实践的。 。启动机器人进行自动作业大致需要两个环节： 一是编制工业机器人自动作业的程序； 二 是启动机器人自动运行的操作方法。 这个项目需要操作者

3、具备一定的知识和操作技能， 如工 业机器人的程序结构、 示教盒编程、 程序调试、 位置示教及程序自动运行的启动等基本方法 和注意事项。本次项目将针对以上内容展开详细的知识讲解和操作技能训练。三、项目任务为了最终实现机器人程序的自动运行，本次项目按照实施步骤划分为以下 3 个任务：任务1.2.1通过示教盒创建简单的机器人搬运程序任务1.2.2单步运行程序及示教机器人位置任务1.2.3启动机器人程序的自动运行四、项目知识1.2.1机器人程序的基本概念1、机器人程序的基本构成一个机器人程序文件主要包含程序名称、程序指令语句、位置数据等3个基本构成要素。各个要素的基本知识如下：（1）程序名称机器人程序

4、的名称必须使用大写英文字母或数字来命名，名称最长为12个字符。在控制箱显示屏上最多只能显示程序名的前4个字符，并且会在程序名左边显示“p.”字符（表示程序）。不足4个字符时，显示屏会自动在程序名前补0。因此，最好把机器人程序的名称控制在4个字符以内。例如，将机器人的程序名称命为“STA”，则控制箱显示屏上显示“p.OSTA”，如图 1- 1 所示。 严 X. M1 9*4 1 * 律 STATUS NUMACR图1- 1控制箱上的程序名称显示（2）程序指令语句列表机器人程序指令语句主要由步号、命令语、数据、附随语句、标识语句等元素组成。如图1- 2所示。命令语句数据 附随语句步号Sfvs P0

5、 HOpen 1标识语句* Circle34567S9Xlvs Pl5-50Mvs PlDiv 0.5*HClose 1Dly 0.5HOpen 1Dly 0.510 Goto * Circle图1- 2机器人程序语句列表增加一行指令，步号就递增步号：由整数132767表示。每一行指令都有一个步号, 一个整数，并自动添加。命令语：使用 MELFA-BASIC IV 语言所定义的命令语，如表 1- 1 所示。表 1- 1 机器人命令语列表NO.项目内容相关命令语1关节插补动作Mov2直线插补动作Mvs3圆弧插补动作Mvr ， Mvr2 ，Mvc4机器人动作控制命令最佳加减速动作Oadl5抓手控制

6、HOpen ， HClsoe6动作完成确认FINE ，DLY7速度调节OVRD ，JOVRD ，SPD8码垛运算命令Def Plt ， Plt9分支Goto， If Then Else10循环ForNext, While Wend11中断Def Act, Act程序控制命令12子程序GoSub，CallP13定时器Dly14停止Hlt，End15信号输入M_In ， M_Inb ，M_Inw外部信号控制命令16信号输出M_Out ，M_Outb ，M_Outw17附随语句命令Wth，WthIf数据：每个命令所需要的变量或常数等数据。如信号输出命令语句和抓手控制附随语句： 根据需要在机器人作业时

7、附加其它语句， 命令语句。附随语句只能附随在插补动作命令语句的右边。标签语句：作为程序分支的记号，由字符“ * ”加上标识名称构成。标识名由英文字 母大小写（不区分）和数字构成，但是开头必须是英文字母，长度为16 个字符以内，避免 使用保留字。（3）位置数据是指在直交坐标系或关节坐标系下示教保存的位置数据。 凡是程序语句列表中出现的位 置变量都必须有位置数据，否则程序运行时将报错。1.2.2 机器人控制箱的面板构成及其功能按照机器人控制箱中 CPU 集成方式的不同， 三菱机器人控制箱分为 SD 系列和 SQ 系列 型。其中， SD 系列控制箱的 CPU 为内置型，即控制箱箱中包含了机器人控制用

8、的CPU ，而 SQ 系列控制箱中不包含机器人控制用的CPU ，该 CPU 被外置于 Q 系列 PLC 基板上， 是一种Q系列运动控制 CPU。虽然SD系列和SQ系列机器人控制箱内部结构不同，但其外观基本一致，如图 1- 3 所示。下面，对控制箱前面板和后面板的组成及其功能做详细介绍。1）电源开关电源开关的作用是：用于打开或关闭机器人控制箱部分的电源。则需要在等待控制需要注意的是，若SQ系列控制箱在正常工作过程中重启这个开关,箱完成上电初始化后对 Q系列PLC进行复位操作，机器人系统才能重新回到正常状态。10 9 8 7 61314 /15A12 、so5FVDOFF0MODESTARTEMG

9、.STOF5TQP图1- 3控制箱前面板2）USB、电池端口该翻盖是控制箱的 USB和电池端口的盖板。打开该翻盖后可看见用于与个人计算机连接的USB接口以及备份电池。3）END按钮该按钮是机器人程序的循环结束按钮。按压此按钮后，当前执行的程序将会停止在最后一行或END语句行。机器人在做完此次循环的最后一个动作后停止，不再重复运行程序。 按压START按钮（图1- 3的8号部位），程序又返回起始句，机器人重新执行循环动作。4）RESET 按钮该按钮是机器人系统的复位按钮。若机器人系统发生报警时，找到导致系统报警的原因并更正，然后再按压此复位按钮， 则机器人系统可解除报警，系统重新回到待机状态。

10、此外,对于中途停止的当前程序，通过按压此按钮复位后，程序复位至起始步号的命令语句。（复位程序时，必须在控制箱的显示屏（图1- 3的11号部位）显示为当前程序项目时，按压此按钮才能生效）5）EMG.STOP 按钮EMERGENCY STOP开关是机器人系统的紧急停止开关，其功能是：当预测到机器人的动作将发生危险时， 按压此紧急停止开关使机器人本体立即停止动作；同时，切断机器人关节马达的伺服供电，并产生系统报警。EMERGENCY STOP开关被按下后，该开关将持续保持有效状态；若要复位紧急停止 开关，请顺时针旋转 EMERGENCY STOP开关至向上弹出位置，开关恢复无效状态。但此 时系统仍处

11、于紧急停止报警状态，需要按压RESET键来解除报警，使系统复位。6) UP/DOWN 按钮该部位按钮的作用是：在控制箱显示屏所显示的项目下修改该项目的内容或数值。但步号项目是只读的，其内容无法选择或修改。 例如，若控制箱显示屏的当前项目为速度项目时， 按压此部位按钮可调节机器人自动运行的速度比例，最小比例为10%，最大为100%;若控制箱的显示屏显示为程序项目时，按压此部位按钮可选择机器人CPU中存储的所有程序，如图1-4所示。只有在MODE开关(图1- 3的12号部位)处于 AUTOMATIC (自动)模式时，且控 制箱面板取得操作权限的情况下，UP/DOWN按钮的操作才有效。7) CHNG

12、 DISP ( CHANGING DISPLAY )按钮该按钮是控制箱显示屏显示项目的类型切换按钮，其功能是切换控制箱显示屏所显示的不同项目，项目类型和切换顺序如图1- 4所示。速度按压CHNG DISP键，项目类型切换 号程序操作权个UPDOWNCPU中存储的其它程序面板设备信息外部IO示教盒只有在MODE开关处于 AUTOMA TIC模式时，CHNG DISP按钮的操作才有效。Hlt，否则机器人将开始重复图1- 4控制箱显示屏显示内容一览8) START 按钮该按钮是机器人程序的启动按钮。按压此按钮可启动机器人程序的自动运行，机器人系 统便从程序的当前步号开始执行指令，除非程序中有暂停命令

13、循环地执行当前程序的所有命令语句。只有在控制箱面板取得操作权限的情况下，START按钮的操作才有效。9) STOP按钮该按钮是机器人程序的暂停按钮。按压此按钮可使机器人在执行完当前步号的命令语句后暂时停止动作。此时，机器人关节伺服仍然通电开启。若再次按下START按钮，又可继续往下一步号的命令语句运行程序，执行后续程序动作。10) SVO ON 按钮该按钮是机器人系统的关节伺服开启按钮。按下此按钮可为机器人的关节伺服输入电源，关节马达处于待机状态；在控制箱操作面板取得控制权限的情况下，该按钮的操作才有效。11) STATUS NUMBER 数码管显示屏用于显示报警号、速度比例()、程序步号、程

14、序名、当前操作权信息、设备信息等项目，如图1- 5所示。其中，v开头的显示内容为速度项目， p开头的显示内容为程序项目 b.开头的显示内容为设备信息项目中的电池剩余时间，T.开头的显示内容为设备信息项目中的控制箱内部温度。当显示项目的开头字母上方出现亮点， 则表示控制箱操作面板具有操作 权限。速度比阳穆FT名称电池利氽时问 擁%内烏推誉低用警图1- 5控制箱显示屏12) MODE切换开关该开关是机器人系统的模式切换开关。其功能是用于切换示教盒和控制箱操作面板之间的操作权限。在“ AUTOMATIC ”模式下，可通过外部信号或操作面板来启动关节伺服或机 器人程序自动运行；但是此时再按下示教盒“E

15、NABLE ”使能按钮的话，则机器人会因操作 权限冲突而报警；在“ MANUAL ”模式下，需按下示教盒“ ENABLE ”使能按钮，示教盒才获得操作权限；若控制箱发生报警，请设置成如上所述的操作权限，此时再按压RESET按钮便可解除报警。13）SVO OFF 按钮此按钮是机器人系统的关节伺服关闭按钮。按下此按钮可切断机器人关节伺服的电源；在控制箱操作面板取得操作权限的前提下，该按钮的操作才有效。14）TB连接端口用于连接示教盒的专用接口。15）RS232连接端口用于连接RS232串口标准的接口。16）接线盒用于接入外部交流电源。1.2.3机器人系统的常见报警与排除当发生异常时，控制箱正面操作

16、面板的STATUS NUMBER上会显示5位数的异常号码（例:C0010等），同时RESET开关的灯号也会亮起。此外，示教盒上的显示LCD上也会有4位数的异常号码（除去最前面的英文字。例:C0010的情况下，会显示0010）和报警信息。报警代码的意义如下:报警类塑口电源.报警等级有*衣示必须虫启电源。 用4位数字表示口H；高级报警*关闭制服;L：低级报警.停止动作;C： 一般警告，继续劲作;F面简要介绍常见报警代码、原因及其排除方法（1）H0060 :操作面板紧急停止信号输入中 原因：急停按钮被按下，系统无法启动程序。 排除：松开急停按钮，解除急停按钮信号。（2） H5000 :操作权限冲突原

17、因：当Mode开关处于“ AUTOMATIC ”模式下且示教盒的ENABLE按钮有效时,产生操作权限冲突报警。排除：将示教盒的 ENABLE按钮无效，或将控制箱面板上的Mode开关切换至MANUAL ”模式下；然后按压 RESET按钮，解除报警。（3） L5010 :可自动运行错误原因：当控制箱处于“ MAMUAL ”模式下，而外部信号操作权有效，此时发生错误。排除：将控制箱和触摸屏中的“ MODE ”开关切换到“ AUTOMA TIC ”模式；或控制箱 和触摸屏中的“ MODE ”开关切换到“ MANUAL ”模式；再按压“ RESET”按钮，解除错 误报警。五、项目实施任务1.2.1通过示

18、教盒创建简单的机器人搬运程序第1步：机器人系统上电。将机器人控制箱电源开关打向“I”挡，等待机器人系统完成上电初始化，控制箱显示屏显示上一次关机前的画面。第2步：选择系统手动模式。将机器人控制箱前面板上的 MODE （模式）开关打向 MANUAL挡。第3步：启动示教盒。按下示教盒背部的 TB ENABLE使能按钮，按钮灯和前面板上的 ENABLE指示灯亮起, 示教盒启动并进入待机画面。第4步：操作示教盒新建程序，以班级号加学号后2位命名。在待机画面下，按压示教盒的EXE键，进入主菜单画面。MELFA CRiiD-7XXXfer. R3aRV - 3SQC OPTllGHTtC )200 B-2

19、011 MITSUBIS HI ELECTRIC CORPORATION ALL RIGHTS RESERVED按压方向键或直接按压数字键1,选择主菜单中的第1项“管理/编辑”选项，进入程序管理画面；按压“新建”功能对应的F3键，进入程序新建画面。丈管理/編辑：编辑ft置QITRA 14-04-15输入程序名0101 （表示01班01学号），完成后按压EXE键，进入程序编辑画面。在程序编辑画面下，按压插入”功能对应的F3键，进入命令语句编写画面。输入命令语句：HOpen 1。输入完成后按压 EXE键，以执行当前命令语句的输入，画面重现回至程序编辑。在该画面下会出现刚刚输入的一条命令语句，并自动

20、添加步号。按照以上程序输入的步骤继续完成以下所有命令语句的输入。1 HOpe n 1打开抓手12 Mov P0关节插补至初始点P03 Mov p1,-50关节插补至抓取点P1的上方50mm 处4 Mvs p1直线插补至抓取点P15 Dly 0.5延时0.5秒6 HClose 1关闭抓手17 Dly 0.5延时0.5秒8 Mvs p1,-50直线插补至点P1的.上空50mm处9 Mov p0关节插补至初始点 P010 Mov P2,-50关节插补至放置点P2的上方50mm 处11 Mvs p2直线插补至放置点P212 Dly 0.5延时0.5秒13 HOpe n 1打开抓手114 Dly 0.5

21、延时0.5秒15 Mvs p2,-50直线插补至放置点P2的上方50mm 处FUNCTION 键来切换4个功能键的内第6步：保存程序。程序输入完毕后，在程序编辑画面下，不断按压F4功能容，直到示教盒显示屏的功能内容出现“关闭”功能，此时按压该功能下面对应的键，以关闭程序编辑画面，同时画面显示已保存程序，保存后画面回至程序管理画面，如下所示。空程序RDlyO.5 13 HOpen 1 1斗Dly仇,0101奁接切换任务1.2.2单步运行程序并示教机器人位置第1步：打开程序在程序管理画面下，按压示教盒方向键，选择“0101 ”程序，按压EXE键，打开并进入“ 0101 ”程序第2步：单步执行进入“

22、 0101 ”程序的编辑画面后，观察F1F2F3F4等4个功能键的内容，按压FUNCTION键（功能切换键），切换F1功能键对应的功能内容，只至出现“前进”功能，如下图所示。w程序前进2 Mov PO3 Mov pl3-504 Mvs pl裁转对于程序的第1条命令语句而言，由于只是控制气动抓手 1的打开动作，无需启动关节伺服，所以只要按压“前进”功能下方对应的F1键，即可执行第1条命令语句。第1条命令语句执行完毕后，放开 F1键，程序自动跳转至下一条语句，如下图所示。对于第2条命令语句而言，由于是控制位置变量P0的移动动作，涉及到关节的转动。因此，需要事先开启关节伺服。关节伺服开启后，一直按压

23、F1键，程序便执行该条命令语句，机器人开始往目标位置移动（如果还没有对P0进行位置示教，请先别按压 F1键，直接执行第3步步骤的操作，然后再按压 F1键，便可成功地单步执行该条命令语句）。机器人移到目标位置 P0后，放开F1键，程序自动跳转至下一条命名语句；否则，继 续按压F1键，直到松开F1键后程序能自动跳转到下一条命令语句。第3条及以后的命令语句可按照第 1条和第2条命令语句的操作过程执行。凡是命令语句涉及到移动动作的，都必须先开启关节伺服，才能再按压F1键执行，否则会报错。由于是第1次单步运行“ 0101 ”程序，程序中的位置变量 PO、P1和P2均还未被指定 具体的位置。因此，在单步运

24、行这些含有位置变量的命令语句之前，需要对这些位置变量逐一进行位置示教操作，请参见第 3步的步骤操作。第3步：P0的位置示教将光标移至“ 0101 ”程序的第2条命令语句，直接按压 JOG键，进入JOG操作画面。 按压FUNCTION键，切换坐标系至 ef直交坐标系，如下图所示。手动JOG控制机器人，使抓手 1移至目标位置。对于需要抓取工件的目标位置，还需要手动控制抓手1的闭合和打开动作，试探是否能准确抓取目标工件。位置确认后，按压JOG键，退出JOG操作模式画面，重新回至程序编辑画面。按压FUNCTION键，切换F4功能键的功能至“示教”项目；此时，按压F4键，即可读取机器人当前的位置数据，存入所在命令行的位置变量 P0。按照第2步和第3步步骤的操作过程单步运行“0101 ”程序的所有15步命令语句。任务1.2.3启动机器人程序的自动运行第1步：手动JOG控制机器人回到退避点为了机器人自动作业的安全，在自动运行前必须先将机器人手动调回到退避点位置