（7）
（9）
（8）
教导程序主画面介绍
教导程序验证画面介绍
教导程序存储画面介绍
本次设计采用路径规划的原理来实 现教导方式 。触摸屏端通过对路径的分
析，设定相应的电机运动顺序，根据指 令系统自动生成一套工艺程序，并传输 到PLC端进行执行。同时在PLC中有相 应的程序储存区和数据存储区，PLC根 据程序存储区的指令来进行动作。而这 些程序是根据指令系统中的指令、根据 教导程序按一定的顺序组成的。同时 PLC端有两段程序数据存储区，一段为 主臂的程序存储区，另一端为副臂的程 序储存区。在工艺程序执行的时候两段
副臂下行：副臂下行进入模内的位置 （如图点7）
副夹水口：副臂夹取水口的位置（如 图点8）
副臂后行：副臂夹完水口，在模内准 备上行到模外的位置（如图点9）
副臂上行：主臂从模内上行到模外的 位置（如图点10）
（7）
副放水口：副臂放置水口的位置。 （9）
（8）
主臂运动顺序
主待机位→主臂下行→主取产品→ 主臂后行→主臂上行→装箱位置（
不良品位）
教导时主臂的定位顺序
主取产品→主臂后行，主臂下行→ 主待机位→主臂上行→装箱位置（
不良品位）
（3）
（5）（1）
（4） （2）
副臂运动顺序
（10）（6）
副待机位→副臂下行→副夹水口→ 副臂后行→副臂上行→副放水口
教导时副臂的定位顺序
副夹水口→副臂后行，副臂下行→
副待机位→副臂上行→副放水口
自动运行开始
PLC程序运行流程图
N0 判断程序传输是否正
确
在PLC端有相应的子程 序端来对应不同的指令 ，在PLC端实现的为对 于终端电机的具体执行 ，根据指令系统的要求 ，PLC系统相当与一个 控制器和运算器，根据 两段程序区的指令来进 行程序运行。下图为 PLC端程序运行的流程 图：
YES
程序运行状 态初始化
Addr MICO-LOC ：微调操作码
Addr+2
LOC
：位置参数
Addr+1
V
：速度参数
分块程序与显示
源程序→显示
触摸屏端的程序存储和调用是 以源程序为基本，源程序首先经 过分块程序，分成以位置为分界 的N个程序块，再调用分块制表程 序，挑出每个程序块中的位置信 息和动作信息，以待显示，最后 调用显示程序，把各个位置动作 信息显示出来。
教导程序源程序储存区
动作信息存储
（1）有时间参数动作：
格式：ACT ，TPAR
长度：2 words
Addr ACT ：动作操作码
Addr+1
TPAR ：时间参数
（2）无时间参数动作：
格式：ACT
长度：1 words
Addr ACT ：动作操作码
（3）微调动作
格式：MICO-LOC LOC V
长度：4 words
X轴速度 Z轴位置低位 Z轴位置高位
Z轴速度
翻平对应的位 翻直对应的位 翻直时间 . . .
教导程序源程序储存区
位置信息存储
存储结构如右： 长度：17 words
指令在内存中的存储格式为：
Addr LOC ：定位操作码 Addr+1 order ：运动顺序 Addr+2 XL ：X位置低字 Addr+3 XH ：X位置高字 Addr+4 XV ：X速度 Addr+5 YL ：Y位置低字 Addr+6 YH ：Y位置高字 Addr+7 YV ：Y速度 Addr+8 ZL ：Z位置低字 Addr+9 ZH ：Z位置高字 Addr+10 ZV ：Z速度 Addr+11 UL ：U位置低字 Addr+12 UH ：U位置高字 Addr+13 UV ：U速度 Addr+14 VL ：V位置低字 Addr+15 VH ：V位置高字 Addr+16 VV ：V速度
给出程序传 输错误提示
取主臂程序开始 取主臂程序指令码
将所取指令码进行比 较
YES 根据比较结果调用主臂 相应动作子程序NO并在子 程序中判断有无报警
NO
取副臂程序开始 取副臂程序指令码 将所取指令码进行比
较
根据比较结果调用副臂 YES 相 程应 序动 中作 判子 断程 有序 无NO并 报在 警子
NO
.
.
.
.
.
R2000
R3000
教导程序源程序储存区
例如主待机位执行翻 直和等候开模，主臂 程序存储区的值为
R1000 R1001 R1002
R1003 R1004
R1005 R1006 R1007
R1008 R1009 R1010 R1011 R1012
R1400 R1401
R1402 R1403 R1404
R2000
序存储区和副臂程序
存储区两块。每个位
.
.
置对应的分块程序储
. .
. .
存区，储存了该位置
. .

. .
的信息及该位置下的
.
.
动作信息。它是按照
R1399
R2399
位置动作的先后次序 来存储的。存储信息 类型可以分为两大类 ：位置信息，动作信 息。
主臂数据储 存区
副臂数据 储存区
.
.
.
.
.
.
.
R1405 R1406 R1407
R1408
R1409 R1410 R1411
Y轴动作指令码
1400 X轴动作指令码
1403 Z轴动作指令码
1406 复位指令码 1409
置位指令码 1410 带时间测试指令码 1411 等. 候指令 . . Y轴位置低位 Y轴位置高位
Y轴速度 X轴位置低位 X轴位置高位
+ 主臂后行：主臂取完塑件，在模内准备 上行到模外的位置（如图点4）
+ 主臂上行：主臂从模内上行到模外的位 置（如图点5）
+ 装箱位置：主臂放置产品的位置。
（3）
（5）（1）
（4） （2）
副臂的主要位置
副待机位：开始取件前副臂所处位置 ，是机械手副臂工艺程序开始也是工
（10）（6）
艺程序结束的位置（如图点6）
本次设计采用路径规划的原理来实现教导方式
取物点
L型取件
取物点
变形 L型取件
嵌件点
有嵌件式取件
取物点 嵌件点
变形有嵌件式取件
取物点
主臂的主要位置
+ 主待机位：开始取件前主臂所处位置， 是机械手主臂工艺程序开始也是工艺程 序结束的位置（如图点1）
+ 主臂下行：主臂下行进入模内的位置 （如图点2）
+ 主取产品：主臂取注塑件的位置（如图 点3）
判断产量是否到达 NO YES
退出自动运 行
在触摸屏端存储的是工艺程序的源程序，当
需要显示时，把源程序分解成为显示区程序，当 需要生成加工工艺程序的时候则生成执行代码传 输给PLC端执行。
源程序
执行代码
显示区
50个位置的分块程序
教导程序源程序储存
区
主臂程序储
副臂程序
存区
储存区
源程序区分为主臂程
R1000