FANUC Robot自动回原点编程三

AUTO_HOME程序：

5: R[28:角度范围]=.5 ;后台逻辑记录机器人角度与启动自动回原点程序时机器人各轴角度之差。

6: ;

7: R[31:回原点J1最小角度]=R[21:自动停止J1角度]-R[28:角度范围] ;

8: R[32:回原点J2最小角度]=R[22:自动停止J2角度]-R[28:角度范围] ;

9: R[33:回原点J3最小角度]=R[23:自动停止J3角度]-R[28:角度范围] ;

10: R[34:回原点J4最小角度]=R[24:自动停止J4角度]-R[28:角度范围] ;

11: R[35:回原点J5最小角度]=R[25:自动停止J5角度]-R[28:角度范围] ;

12: R[36:回原点J6最小角度]=R[26:自动停止J6角度]-R[28:角度范围] ;

13: ;

14: R[41:回原点J1最大角度]=R[21:自动停止J1角度]+R[28:角度范围] ;

15: R[42:回原点J2最大角度]=R[22:自动停止J2角度]+R[28:角度范围] ;

16: R[43:回原点J3最大角度]=R[23:自动停止J3角度]+R[28:角度范围] ;

17: R[44:回原点J4最大角度]=R[24:自动停止J4角度]+R[28:角度范围] ;

18: R[45:回原点J5最大角度]=R[25:自动停止J5角度]+R[28:角度范围] ;

19: R[46:回原点J6最大角度]=R[26:自动停止J6角度]+R[28:角度范围] ;

20: ;

21: R[51:HOME_J1角度]=SCRGRP[1].SCR_GRP[1].SCRGRP[1].MCH_ANG[1]
;将机器人当前第一轴的角度赋值给数值寄存器R[51]。以下类似。

22: R[52:HOME_J2角度]=SCRGRP[1].SCR_GRP[1].SCRGRP[1].MCH_ANG[2]
;

23: R[53:HOME_J3角度]=SCRGRP[1].SCR_GRP[1].SCRGRP[1].MCH_ANG[3]
;

24: R[54:HOME_J4角度]=SCRGRP[1].SCR_GRP[1].SCRGRP[1].MCH_ANG[4]
;

25: R[55:HOME_J5角度]=SCRGRP[1].SCR_GRP[1].SCRGRP[1].MCH_ANG[5]
;

26: R[56:HOME_J6角度]=SCRGRP[1].SCR_GRP[1].SCRGRP[1].MCH_ANG[6]
;

27: ;

28: ;

29: IF R[51:HOME_J1角度]<R[31:回原点J1最小角度] OR R[51:HOME_J1角度]>R[41:回原点J1最大角度],JMP LBL[10000] ;若第一轴角度超标，则跳转到报警的标签。以下类似。

30: ;

31: IF R[52:HOME_J2角度]<R[32:回原点J2最小角度] OR R[52:HOME_J2角度]>R[42:回原点J2最大角度],JMP LBL[10000] ;

32: ;

33: IF R[53:HOME_J3角度]<R[33:回原点J3最小角度] OR R[53:HOME_J3角度]>R[43:回原点J3最大角度],JMP LBL[10000] ;

34: ;

35: IF R[54:HOME_J4角度]<R[34:回原点J4最小角度] OR R[54:HOME_J4角度]>R[44:回原点J4最大角度],JMP LBL[10000] ;

36: ;

37: IF R[55:HOME_J5角度]<R[35:回原点J5最小角度] OR R[55:HOME_J5角度]>R[45:回原点J5最大角度],JMP LBL[10000] ;

38: ;

39: IF R[56:HOME_J6角度]<R[36:回原点J6最小角度] OR R[56:HOME_J6角度]>R[46:回原点J6最大角度],JMP LBL[10000] ;

FANUC Robot自动回原点编程三相关推荐

【Linux】网络编程三：TCP通信和UDP通信介绍及代码编写
参考连接:https://www.nowcoder.com/study/live/504/2/16. [Linux]网络编程一:网络结构模式.MAC/IP/端口.网络模型.协议及网络通信过程简单介绍 ...
php三要素,并发编程三要素：原子性，有序性，可见性
并发编程三要素 **原子性:**一个不可再被分割的颗粒.原子性指的是一个或多个操作要么全部执行成功要么全部执行失败. 有序性: 程序执行的顺序按照代码的先后顺序执行.(处理器可能会对指令进行重排序) ...
扫地机自动回充揭秘之小米/iRobot/云鲸/360
上一篇:扫地机自动回充揭秘之石头T7 Pro 这篇文章想和大家分享一下其他扫地机的自动回充方式,包括iRobot.小米.云鲸.360.处于之前的博文关于自动回充的介绍比较多了,这里就分享一下这几款扫地 ...
扫地机器人自动回充原理
扫地机器人自动回充,有多种技术原理,有采用雷达定位的.采用蓝牙定位的.红外线定位的.在扫地机器人领域主要是利用这3种定位技术. 一.采用超声波定位一种扫地机器人是采用超声波定位来寻找充电基座的,超声 ...
PLC运动控制系列之机械回原点(back to origin)
大部分运动控制都会对机械回原点进行大篇幅讲解,也可以看出机械回原点的重要性.常规的回原点方式大概有十几种,本文会给出常用回原点的注意事项,和编程推荐写法.如果原点回归速度.脉冲的加减速时间以及限位.原 ...
FX5u控制4个伺服，一个完整的项目程序用标签分层，说明了定位控制中的公共参数设定、回原点、
FX5u控制4个伺服,一个完整的项目程序用标签分层,说明了定位控制中的公共参数设定.回原点.JOG手动.绝对定位.相对定位.控制等部分,威纶程序报警界面.多个机种选择,手动,自动,暂停,包括有: ...
FX5u控制4个伺服，一个完整的项目回原点、JOG手动、绝对定位、相对定位、控制等部分
FX5u控制4个伺服,一个完整的项目程序用标签分层,说明了定位控制中的公共参数设定.回原点.JOG手动.绝对定位.相对定位.控制等部分,威纶程序报警界面.多个机种选择,手动,自动,暂停,包括有: ...
GRBL 回原点设置
GRBL V1.1回原点设置以arduino uno为例说明先决条件: 正确配置各轴. 回原点开关的引脚和接线 3个用于限位开关的数字输入引脚用于向Grbl发送信号: 引脚9 X轴限制/原点输入 ...
SpringBoot异常处理回滚事务详解(自动回滚、手动回滚、部分回滚）
参考:https://blog.csdn.net/zzhongcy/article/details/102893309 概念事务定义事务,就是一组操作数据库的动作集合.事务是现代数据库理论中的核心 ...

FANUC Robot自动回原点编程三

FANUC Robot自动回原点编程三相关推荐

最新文章

热门文章