莫托曼机器人测温程序

1机器程序

2.1 主程序

MAIN:

NOP

CALL JOB:ORG

*1

JUMP *5 IF IN#(41)=OFF

CALL JOB:远程 IF IN#(25)=ON

CALL JOB:本地 IF IN#(26)=ON

CALL JOB:测距判断

CALL JOB:最后一支

*5

CALL JOB:PZ IF IN#(35)=ON

CALL JOB:PZ IF IN#(65)=ON

JUMP *1

END

1.2 本地程序

1、本地:

NOP

CALL JOB:分步 IF IN#(22)=ON

CALL JOB:单循环 IF IN#(23)=ON

END

2、分步:

NOP

CALL JOB:装CW枪头 IF IN#(28)=ON

CALL JOB:装DY枪头 IF IN#(29)=ON

CALL JOB:装QY枪头 IF IN#(27)=ON

CALL JOB:下枪2 IF IN#(31)=ON

CALL JOB:下枪1 IF IN#(32)=ON

END

3、单循环:

NOP

CALL JOB:测温 IF IN#(28)=ON

CALL JOB:定Y IF IN#(29)=ON

CALL JOB:取Y IF IN#(27)=ON

END

1.3 远程程序

1、远程:

NOP

CALL JOB:PC-手动 IF IN#(73)=ON

CALL JOB:PC-自动 IF IN#(74)=ON

END

2、PC-手动:

NOP

JUMP JOB:装CW枪头 IF IN#(60)=ON

JUMP JOB:装DY枪头 IF IN#(61)=ON

JUMP JOB:装QY枪头 IF IN#(62)=ON

JUMP JOB:下枪1 IF IN#(63)=ON

JUMP JOB:下枪2 IF IN#(64)=ON

END

3、PC-自动:

NOP

CALL JOB:测温 IF IN#(60)=ON

CALL JOB:定Y IF IN#(61)=ON

CALL JOB:取Y IF IN#(62)=ON

END

1.4 其他程序

1、ORG:

NOP

SET B040 0

SET B041 0

SET B042 0

SET B043 0

DOUT OT#(56) OFF

DOUT OT#(148) OFF

DOUT OT#(149) OFF

DOUT OT#(150) OFF

DOUT OT#(145) OFF

DOUT OT#(146) OFF

DOUT OT#(147) OFF

DOUT OT#(233) OFF

DOUT OT#(234) OFF

DOUT OT#(235) OFF

DOUT OT#(25) OFF

DOUT OT#(26) OFF

DOUT OT#(27) OFF

DOUT OT#(29) OFF

DOUT OT#(30) OFF

DOUT OT#(51) OFF

DOUT OT#(52) OFF

DOUT OT#(53) OFF

END

2、测距判断

NOP

JUMP *CJ IF D011<-600000

JUMP *CJ IF D012>600000

JUMP *CJ0 IF D011=0

JUMP *CJ0 IF D012=0

JUMP *CJ0 IF IN#(82)=ON

JUMP *CJEND

*CJ

JUMP *CJEND IF D011<-800000

JUMP *CJEND IF D012>800000

DOUT OT#(73) ON

JUMP *CJEND1

*CJ0

DOUT OT#(73) OFF

JUMP *CJEND1

*CJEND1

*CJEND

END

3、最后一支

NOP

JUMP *L1 IF B003=40

JUMP *L2 IF B013=48

JUMP *L3 IF B023=32

JUMP *L4

*L1

DOUT OT#(147) ON

JUMP *L4

*L2

DOUT OT#(145) ON

JUMP *L4

*L3

DOUT OT#(146) ON

*L4

END

4、装CW枪头:

NOP

JUMP *21 IF B050=1

DOUT OT#(26) ON

DOUT OT#(51) ON

CALL JOB:测温弹仓

CALL JOB:测温装枪

SET B052 1

TIMER T=0.20

DOUT OT#(51) OFF

DOUT OT#(26) OFF

SET B050 1

TIMER T=0.50

*21

END

5、装DY枪头:

NOP

JUMP *22 IF B050=1

DOUT OT#(27) ON

DOUT OT#(52) ON

CALL JOB:定y弹仓

CALL JOB:定Y装枪

SET B052 2

DOUT OT#(52) OFF

DOUT OT#(27) OFF

TIMER T=0.20

SET B050 1

TIMER T=0.50

*22

END

6、装QY枪头:

NOP

JUMP *23 IF B051=1

DOUT OT#(25) ON

DOUT OT#(53) ON

CALL JOB:取Y弹仓

CALL JOB:取Y装枪

TIMER T=0.20

DOUT OT#(53) OFF

DOUT OT#(25) OFF

TIMER T=0.20

SET B051 1

TIMER T=0.50

*23

END

7、下枪1:

NOP

JUMP *25 IF B051=0

DOUT OT#(30) ON

DOUT OT#(61) ON

TIMER T=0.20

CALL JOB:QY-X-X

DOUT OT#(61) OFF

DOUT OT#(30) OFF

TIMER T=0.20

SET B051 0

TIMER T=0.50

*25

END

8、下枪2:

NOP

JUMP *24 IF B050=0

JUMP *24 IF B052>2

JUMP *24 IF B052=0

DOUT OT#(29) ON

DOUT OT#(62) ON

JUMP *241 IF B052=1

JUMP *242 IF B052=2

*241

CALL JOB:CW-X-X

SET B052 0

TIMER T=0.50

JUMP *240

*242

CALL JOB:DY-X-X

SET B052 0

TIMER T=0.50

*240

TIMER T=0.20

DOUT OT#(62) OFF

DOUT OT#(29) OFF

TIMER T=0.20

SET B050 0

TIMER T=0.50

*24

END

9、测温:

NOP

DOUT OT#(26) ON

DOUT OT#(51) ON

CALL JOB:装CW枪头

TIMER T=0.30

CALL JOB:下枪2

DOUT OT#(51) OFF

DOUT OT#(26) OFF

END

10、定Y:

NOP

DOUT OT#(27) ON

DOUT OT#(52) ON

CALL JOB:装DY枪头

TIMER T=0.30

CALL JOB:下枪2

DOUT OT#(52) OFF

DOUT OT#(27) OFF

END

11、取Y:

NOP

DOUT OT#(25) ON

DOUT OT#(53) ON

CALL JOB:装QY枪头

TIMER T=0.30

CALL JOB:下枪1

DOUT OT#(53) OFF

DOUT OT#(25) OFF

END

相关推荐
yoloGina6 小时前
AI 机器人外呼 —— 开启智能外呼新纪元
人工智能·机器人
视觉语言导航7 小时前
ICML-2024 | 具身智能如何数据自由?RoboGen:基于生成式模拟实现全自动无限数据机器人学习
人工智能·机器人·具身智能
Axis tech1 天前
当机器人遇见艺术:春晚机器人舞蹈,一场科技与艺术的完美邂逅
科技·机器人
向阳逐梦1 天前
ROS进阶:使用URDF和Xacro构建差速轮式机器人模型
机器人
机器学习之心1 天前
机器人路径规划 | 基于极光PLO优化算法的机器人三维路径规划Matlab代码
算法·matlab·机器人·三维路径规划
晨欣2 天前
基于LangGraph和Ollama实现可调用AI搜索引擎Tavily的Agentic RAG问答机器人
人工智能·搜索引擎·机器人
shichaog2 天前
腿足机器人之五- 粒子滤波
机器人
xwz小王子2 天前
RoboBERT:减少大规模数据与训练成本,端到端多模态机器人操作模型(西湖大学最新)
机器人·端到端大模型
珠海新立电子科技有限公司2 天前
精准医疗的“柔性”助力:FPC在医疗机器人中的应用实例【新立电子】
人工智能·机器人·fpc
shichaog2 天前
腿足机器人之八- 腿足机器人动力学
算法·机器人