安川码垛程序实例

1、NOP *T_START WAIT IGH#(1)=8等待信号全为1输入组号PULSE OGH#(1) 8 T=0.50外部输出信号输出脉冲输出组号*SIDE_SEL 标号字符串JUMP *NEAR IF IN#(6)=ON信号6有输入信号跳转到*nearJUMP *FAR IF IN#(27)=ON信号27有信号跳转到*farJUMP *SIDE_SEL*NEAR PULSE OGH#(1) 11 T=0.50外部输出信号输出脉冲输出组号WAIT IGH#(1)=11等待第一组为1011*INISEL JUMP *NEAR_INI IF IN#(6)=ONJUMP *A10 IF IN#(7

2、)=ONJUMP *INISEL*NEAR_INISET B001 0设定b1 为0SUB P001 P001数据相减 P1 置零SUB P002 P002数据相减 P2 置零SUB P003 P003数据相减 P3 置零SUB P004 P004数据相减 P4 置零SET D001 215000将D1 设为215000SET D002 215000将D2 设为215000SET D003 6000将D3 设为6000SET D004 200000将D4 设为200000SETE P001 (3) D001设定P1 元素3 为D1SETE P002 (3) D002设定P2 元素3 为D2SE

3、TE P003 (3) D003设定P3 元素3 为D3SETE P004 (3) D004设定P4 元素3 为D4SUB P011 P011置零SUB P012 P012置零SUB P015 P015置零SUB P016 P016 置零MOVJ C00000 VJ=25.00移动到位置 C0MOVJ C00001 VJ=25.00移动到位置 C1MOVJ C00002 VJ=25.00移动到位置 C3*A00 SUB P011 P003 p11-p3=p11GETE D011 P011 (3)SUB D011 D003 JUMP *T_START IF D011-780000SFTON P0

4、11 BF 以基座坐标动作MOVL C00003 V=50.0SFTOF 停止平移动作JUMP *A00 IF IN#(5)=ON跳转 到*A00 如果in5为onJUMP *A11_END跳转 *A11_end*A10 MOVJ C00004 VJ=25.00MOVJ C00005 VJ=25.00MOVJ C00006 VJ=25.00*A11 GETE D011 P011 (3)SUB D011 D001 JUMP *A12 IF D011-780000SUB P015 P004SUB P011 P001SFTON P011 BF P11 以基座坐标运行MOVL C00007 V=100

5、.0SFTOF 停止基座坐标JUMP *A11_END*A11_END PULSE OGH#(1) 7 T=1.00暂停 WAIT IGH#(1)=3 等待输入组MOVL C00008 V=100.0MOVJ C00009 VJ=25.00JUMP *T_END*A12 GETE D012 P012 (3)读取p12的z轴到d12中SUB D012 D002 d12-d2=d12JUMP *T_START IF D012-780000SUB P015 P004p15-p4=p15SUB P012 P002p12-p2=p12SFTON P012 RFp12机器人坐标运行SFTON P011 B

6、F P11基座坐标运行MOVL C00010 V=100.0SFTOF结束机器人坐标SFTOF结束基座坐标*A12_END PULSE OGH#(1) 7 T=1.00使第一组输出111 后延时一段时间关闭WAIT IGH#(1)=3 等待输入第一组信号为11MOVL C00011 V=100.0MOVJ C00012 VJ=25.00JUMP *T_END*T_END PULSE OGH#(1) 5 T=0.50使第一组输出101 后延时一段时间关闭WAIT IGH#(1)=5 等待输入第一组信号为101MOVJ C00013 VJ=25.00 PL=0PULSE OGH#(1) 6 T=0

7、.50WAIT IGH#(1)=6 等待输入第一组信号编号为6=110MOVJ C00014 VJ=25.00JUMP *LABEL1*KONGTIAO WAIT IGH#(1)=8 等待输入第一组信号为1000PULSE OGH#(1) 8 T=0.50使第一组输出1000 后延时一段时间关闭MOVJ C00015 VJ=25.00MOVL C00016 V=300.0 PULSE OGH#(1) 10 T=0.50使第一组输出1010 后延时一段时间关闭WAIT IGH#(1)=10 等待输入第一组信号为1010MOVL C00017 V=300.0 MOVL C00018 V=300.0

8、 PL=0PULSE OGH#(1) 11 T=0.50使第一组输出1011 后延时一段时间关闭WAIT IGH#(1)=11等待输入第一组信号为1011*END3 结束标记MOVL C00019 V=300.0 PL=0MOVJ C00020 VJ=25.00MOVJ C00021 VJ=25.00PULSE OGH#(1) 13输出信号为1101延时一段时间WAIT IGH#(1)=13 等待第一输入组为1101MOVJ C00022 VJ=25.00MOVJ C00023 VJ=25.00 MOVJ C00024 VJ=25.00 PL=0PULSE OGH#(1) 12 T=0.50输出信号为1100延时一段时间WAIT