SQ1YV1YV2SQ2SQ3YV5SQ4AYV4PSYV3SB1BSB2
图7-29 机械手控制示意图
3. 控制程序设计
根据控制要求先设计出功能流程图,如图7-30所示。根据功能流程图再设计出梯形图程序,如图7-31所示。流程图是一个按顺序动作的步进控制系统,在本例中采用移位寄存器编程方法。用移位寄存器M10.1~M11.2位,代表流程图的各步,两步之间的转换条件满足时,进入下一步。移位寄存器的数据输入端DATA(M10.0)由M10.1~M11.1各位的常闭接点、上升限位的标志位M1.1、右转限位的标志位M1.4及传送带A检测到工件的标志位M1.6串联组成,即当机械手处于原位,各工步未起动时,若光电开关PS检测到工件,则M10.0置1,这作为输入的数据,同时这也作为第一个移位脉冲信号。以后的移位脉冲信号由代表步位状态中间继电器的常开接点和代表处于该步位的转换条件接点串联支路依次并联组成。在M10.0线圈回路中,串联M10.1~M11.1各位的常闭接点,是为了防止机械手在还没有回到原位的运行过程中移位寄存器的数据输入端再次置1,因为移位寄存器中的“1”信号在M10.1~M11.1之间依次移动时,各步状态位对应的常闭接点总有一个处于断开状态。当“1”信号移到M11.2时,机械手回到原位,此时移位寄存器的数据输入端重新置1,若起动电路保持接通(M0.0=1),机械手将重复工作。当按下停止按钮时,使移位寄存器复位,机械手立即停止工作。若按下停止按钮后机械手的动作仍然继续进行,直到完成一周期的动作后,回到原
位时才停止工作,将如何修改程序。
I0.1·I0.4 原位 右限位I0.4,上限位I0.1压下 I0.0起动 保持 M11.1 Q0.6 传送带A
I0.6 PS M10.1 Q0.2 下降 I0.2下限位 M10.2 Q0.5 T37 夹紧并保持
T37 M10.3 Q0.1 上升 I0.1上限位 M10.4 Q0.3 左转 I0.3左限位 M10.5 Q0.2 下降 I0.2下限位 M10.6 R Q0.5 T38 松开
T38 M10.7 Q0.1 上升 I0.1上限位 M11.0 Q0.4 Q0.7 机械手右转,传送带BI0.4右限位 图7-30 机械手流程图
图7-31 机械手梯形图
机械手梯形图续