安川机器人操作及简单故障处理

1、安川 机器人操作及简单故障处理一 机器人简介1、硬件构成：我公司二期所用的日本安川公司机器人共有 15 台，全部为MOTOMA列产品，共有SK12Q SK6 SV3及UP6四种型号。 四种型号的机器人都是由机器人本体，控制柜两部分构成。机器人本体上装有伺服马达，传动机构及减速机构等机械装置。这 几种型号的机器人都是有六个轴关节，由六台伺服马达和六套传动机构 组成。六个轴的名称分别为 S、L、 U、R、B、 T 轴，其中 S 轴控制整个 本体的来回旋转、 L 轴控制机器人下臂的前后摆动、 U 轴控制机器人上 臂上下摆动、R轴控制上臂的来回旋转、B轴控制机器人手腕的上下摆 动、 T 轴控制手腕的来

2、回旋转。六个马达共同运动可以使机器人运行到 其工作范围内的任意的一个空间位置。控制柜内装有全部控制装置、再现操作盒及示教盘。控制装置包括 主计算机（CPU单元），伺服马达驱动器，各种外部信号输入输出板，电 源装置等。此系列机器人电源的额定输入为 AC220V 50/60HZ三相电源, 在国内使用时必须配备电源变压器。再现操作盒上装有各种操作按纽、 指示灯及通讯口等装置。示教盘上有液晶显示器和各种操作按纽，主要 用于编写程序、操作机器人及观察其工作状况等。2、机器人工作方式：机器人的工作方式为示教再现型，即由操作者操作机器人完成一遍所有的预定动作，机器人记录下所走过各个位 置点的坐标随后自动运行

3、中按照示教的位置、速度完成所有动作机器人运动时的坐标系统有五个分别为：关节坐标系、直角坐标 系、圆柱坐标系、工具坐标系和用户坐标系。机器人在关节坐标系中运 动方式为各轴单独运动互不影响； 在直角坐标系中机器人以本体轴的 X、 Y、Z三个方向平行移动；在圆柱坐标系中机器人以本体轴 Z轴为中心回 旋、直角或平行移动；在工具坐标系中机器人以工具尖端点的X、 Y、 Z轴平行移动； 在用户坐标系中由用户在机器人工作的范围之内任意设定 不同角度的X、Y Z轴，机器人可延所设的各轴平行移动。二 机 器人的操作和程序的编写1、 再现操作盒操作键说明：见 P2-32、 示教盘操作键说明：见 P2-63、程序结构

4、说明：机器人的程序语言为安川公司自己开发的专 用语言（ INFORMII ），其指令主要分为移动指令、输入输出指令、控制 指令和平移指令、运算指令等。移动指令主要有 MOV（J 关节移动）， MOV（L 直线移动）， MOV（C 圆 弧移动）等。其功能是控制机器人以移动命令规定的方式和速度运行到 命令指定的位置。输入输出指令主要有DOUT（开关量输出的ON或OFF, DIN （将外 部开关量输入信号读入），WAIT（等待外部执行条件满足），AOUT（模拟 信号输出）等。控制指令主要有JUMP（转移到其它程序步），CALL（调出指定的程 序） , END（程序结束），TIMER（延时规定的时间）

5、，IF （条件判断）等。运算指令主要有 ADD（数据加），SUB（数据减），MUL（数据乘），DIV （除）AND（数据与），OR（数据或）等。功能是对4、编写机器人程序的步骤：大致确定工作所需的位置，打开机器 人伺服电源、按下ENABLE键。再用各轴移动键将机器人移动到第一点， 按下MOTION TYP键选择运动方式、按下 PLAY SPD键选择运动速度， 按下ENTER!确认，第一步程序即编辑完成。用各轴移动键将机器人移 动到第二点，用同样的方法确定运动方式和速度完成第二步程序。以此 类推完成其它各步骤。最后一步位置要和第一步位置重合可采用如下方式，调出已编辑好的程序，将光标移动到第一步，

6、按下 FWD键机器人向 设定的第一步的位置移动，到达位置后将光标移动到最后一步，按下 MODIFY键再按下ENTER!，最后一步的位置就和第一步重合。5、程序的检查：按下DISP键再按下F1 （JOB键，将光标移动到 第一步，按下FWD键机器人按照编制好的轨迹运动。6、程序举例说明：排气投入机器人程序主程序（MASTER JOB说明：NOP（空操作）CLEAR STACK堆 栈清零）DIN B000 IN#（21） （21#输入送到变量 B000）22#输入送到变量 B001)23#输入送到变量 B002)(B000与 B001)(BOOO与 B001)如条件满足跳转到 *1 步) 如条件满足

7、跳转到 *1 步) 关闭输出 1#) 关闭输出 2#) 如条件满足调子程序 QF)DIN B001 IN#(22)DIN B002 IN#(23)AND B000 B001AND B000 B002JUMP *1 IF IN#(8)=OFFJUMP *1 IF IN#(3)=ONDOUT OT#(1) OFFDOUT OT#(2) OFFCALL JOB:QF IF B000=1*1MOVJ C0000 VJ=70.00END子程序QF说明：NOPMOVJ C0000 VJ=50.00 JUMP *10 IF IN#(29)=OFF MOVJ C0001 VJ=50.00 MOVJ C0002

8、 VJ=50.00 MOVL C0003 V=200.0 DOUT OT#(1) ON移动到工作原点位置)空操作)移动到位置 C000) 如条件满足跳转到 *10 步)(移动到位置 C001)移动到位置 C002)移动到位置 C003) 输出 1#ON)TIMER T=2.00JUMP *11 IF IN#(3)=ONDOUT OT#(9) ONPAUSE*11DOUT OT#(9) OFFDOUT OT#(21) ONWAIT IN#(30)=ONDOUT OT#(21) OFFMOVL C0004 V=300.0MOVL C0005 V=800.0MOVL C0006 V=800.0MOV

9、J C0007 VJ=50.00JUMP *12 IF IN#(3)=OFFMOVJ C0008 VJ=50.00MOVJ C0009 VJ=50.00MOVJ C0010 VJ=50.00MOVJ C0011 VJ=50.00MOVJ C0012 VJ=50.00MOVJ C0013 VJ=50.00（延时 2 秒） （如条件满足跳转到 *11 步）（输出 9#ON）（暂停）（输出 9#OFF）（输出 21#ON）（等待输入 30#ON）（输出 21#OFF）（移动到位置 C004）（移动到位置 C005）（移动到位置 C006）（移动到位置 C007）（如条件满足跳转到 *12 步）（移动

10、到位置 C008）（移动到位置 C009）（移动到位置 C0010）移动到位置 C0011）移动到位置 C0012）移动到位置 C0013）MOVJ C0014 VJ=50.00WAIT IN#(31)=OFFWAIT IN#(31)=ONMOVL C0015 V=1100.0MOVL C0016 V=200.0DOUT OT#(1) OFFDOUT OT#(2) ONTIMER T=0.50MOVL C0017 V=50.0MOVL C0018 V=1500.0MOVJ C0019 VJ=50.00DOUT OT#(2) OFFMOVJ C0020 VJ=50.00MOVJ C0021 VJ

11、=50.00MOVJ C0022 VJ=50.00 *12MOVJ C0023 VJ=50.00*10（移动到位置 C0014）（等待输入 31#OFF）（等待输入 31#ON）（移动到位置 C0015）（移动到位置 C0016）（输出 1#OFF）（输出 2#ON）（延时 0.5 秒）（移动到位置 C0017）（移动到位置 C0018）（移动到位置 C0019） （输出 2#OFF）（移动到位置 C0020）移动到位置 C0021）移动到位置 C0022）移动到位置 C0023）RET （返回）END 三 机器人的开，关机步骤1打开机器人供电电源开关及压缩空气开关。2打开机器人控制柜上的主电

12、源开关。等机器人自检完毕后按下 伺服电源按钮接通马达的伺服电源。按下控制柜上示教按钮（ TEACH）， 使机器人转入示教模式。3. 按下示教盘上 DISP键；按SELECT;按F5 （MJCALL键调出 主程序。按上下箭头键将光标移到运动的第一步（其程序一般为 XXX 001 MOVJ VJ=70% ）；移到此处后若光标闪烁，说明机器人目前处不 于原点位置。此时应手动操作机器人移动回原点后方可开机。4. 机器人回原点的方法为：移动光标到主程序（ MJ）中运动的第 一步；按下ENABLE键；按住FWD键机器人即向原点方向移动此时应注 意观察机器人运动方向上有无障碍物，如有发生碰撞的可能松开FWD

13、键 机器人即停止运动。移去障碍物或使用各轴单独运动键使其绕过障碍物，继续按住FWD键直到机器人停止运动同时光标也不再闪烁。此时的 位置为原点位置。5. 在主程序中将光标移到程序的第一行， 将控制柜模式选择为 PLAY 及AUTO，女口 ENABLE灯亮再按一次使其熄灭。将显示盘上机器人模式 开关打到联机模式。如其它两方的联机指示灯均亮，即可按下控制柜上 START键，机器人此时开始自动工作。HOLD6. 关机步骤，当需要暂时停止机器人工作时可按下控制柜上按纽，机器人仍在 AUTO模式下，重新启动再按下 START即可。生产结束不再有管子流来时。如机器人处于原点关闭控制柜上电源开关即可。 如机器

14、人不在原点，按照前述第四步将其示教回原点即可关闭主电源开关。四. 输入输出点及变量的监控1. 各开关量输入输出点状态及变量状态监控：按下DISP键，按下F5 (DIAG 键再按下F1 (UNIV IN)或F2 ( UNIV OUT键，此时就可 观察到输入或输出点的状态。按箭头键可选择所需观察的I/O号 码。在每个I/O点后均有一个圆圈，如此圆圈为白色说明此点为 OFF状 态，如圆圈为黑色说明此点为 ON状态。在机器人程序中可能会使用许 多不同的变量，观察变量具体值的方法为按 DISP键，按下F4 (VAR键 再根据显示各个不同的变量名按下 F1 F5键选择所需要观察的变量。2. 输出点的打开与

15、关闭，变量值的修改：利用示教盘可对输出点的状态和变量值进行修改。当显示输出点的状态时按下EDIT键，用箭头键选择输出点按下F4 (ON或F5 (OFF)打开或关闭输出点。在观察 到变量值的菜单中按下EDIT键，按下MODIFY再按下具体数字键输入 变量的值。五. 简单故障处理当机器人无法正常工作时，如果有机器人自身的报警信号出现，操作者可根据示教盘上具体的报警代码参照使用说明书上的处理方法进行处理。消除报警后再重新启动如机器人本身无报警信号出现此时应观察机器人程序，检查程序停 止的位置确认其无法执行的原因。 大部分故障的原因都是因为周边设备 与机器人的接口信号异常造成的。应注意检查各相关传感器

16、和开关等， 确认有无异常情况。机器人瞬间停电电力恢复供应后，首先检查气压是否足够。如气压达到5MPa可以打开机器人电源。此时如果机器人吸盘上仍有管子应按照手动操作方法将管子放下，将机器人示教回原点后开机。机器人如果有管子吸在吸盘上，首先应手动操作机器人移动到合适的位置放下管子再将机器人示教回原点方可启动。解除真空的方法为先关闭真空阀（0UT#1 OFF,再打开吹气阀（OUT#2 0）如果停电后或生产启动重新打开电源后出现 0380 或 5040 错误代 码时按如下步骤处理：1. 打开伺服电源2. 按下 TEACH3. 按下 CUSTOMER4. 按下 F3（ SPEC PT）5. 按下 F1（ PSN CHG）6. 按下 ENABLE7. 按下 MODIFY8. 按下 ENTER9. 按下 F4 (CHECK六. 日常维护及点检机器人的日常点检工作十分重要。只有按时完成这些工作才能确保机器人的正常工作。具体项目及方法可参照下表执行检杳部位检杳项目周期检查方法备注控制柜控制柜门是否关好每日目视确认门密封橡胶无损坏每月目视确认各接插件，端子无松动每月手动，螺丝刀冷却风扇确认风扇转动每日目视电源开时电池确认控制柜内SY