机械手毕业论文(6)

PLC外部电气接线图4-2

4.2 控制系统软件设计

机械手控制系统软件设计的程序总体结构如图4-3，分为公用程序、自动程序、手动程序和回原位程序等四部分。其中自动程序包括单步、连续运动程序，因它们的工作顺序相同所以可将它们和编在一起。CJ（FNC00）是条件跳转应用指令，指针标号PX是其操作数。该指令由于某种条件下跳过CJ指令和指针标号之间的程序，从指针标号处继续执行，以减少程序执行时间。如果选择“手动”工作方式，即X0为ON，X1为OFF则PLC执行完公用程序后将跳过自动程序到P0处，由于X0动断触点断开所以直接执行“手动程序”。由于P1处的X1的动断触点闭合，所以又跳过回原位程序到P2处。如果选择“回原位”工作方式，同样只执行公用程序和回原位程序，如果选择“连续”方式，则只执行公用程序和自动程序。

4.2.1 公用程序

公用程序如图4-4，简要说明如下：当Y6复位（电磁阀松开）、后限位X21和上限位X17接通时，辅助继电器M0变为ON，表示机械手在原位。如果开始执行用户程序（M8002为ON）、系统处于手动或回原位状态（X0或X1为ON），那么初始步对应的M10被置位，连续工作方式做好准备。如果M0为OFF，M10被复位，系统不能进入连续工作方式。指令ZRST是成批复位应用指令，以防止系统从自动方式转换手动方式，再返回自动方式时出现两种不同的活动步。

13

图4-3 程序总的结构图

图4-4公用程序梯形图

14

4.2.2 自动操作程序

自动操作顺序功能流程图见图4-5所示。当机械手处于原位时，按启动X4接通，状态转移到S1，驱动前伸Y3，当到达前限位使行程开关X20接通，状态转移到S2，而S1自动复位。驱动手顺转Y7，X24接通，状态转移

到S3，驱动下降Y2，X16接通，状态转移到S4，S4驱动Y6置位，延时1秒，以使电磁力达到最大夹紧力。当T0接通，状态转移到S5，驱动Y0上升，当上升到达最高位，X17接通，状态转移到S6。S6驱动Y4后退。

移到后限位，状态转移到S7底逆转Y12，状态到S8，X20接通，状态转移到S9下降。下降到最低位，X16接通，电磁铁放松。为了使电磁力完全失掉，延时1秒。延时时间到，T1接通，状态转移到S11上升。上升到最高位，X25接通，状态转移到S13后退。后退到后限位，使X21接通，状态转移到S14，底盘顺转是X21接通，返回初始状态，再开始第二次循环动作。

在编写状态转移图时注意各状态元件只能使用一次，但它驱动的线圈，却可以使用多次，但两者不能出现在连续位置上。因此步进顺控的编程，比起用基本指令编程较为容易，可读性较强。

初始回原点前伸/手顺转下降夹紧上升后退底逆转前伸/下降松开上升手逆转后退底顺转图4-5 自动的功能流程图 15

自动连续程序说明：当系统处于自动连续方式时，X2为ON，它的动合触点闭合，在初始步时按下启动按钮X4，M1得电并保持，就按照图4-5自动功能图进行工作。按下停止按钮X7后，M1变为OFF，系统不会立即停止，而是完成当前的工作周期后，机械手最终停止在原位。

根据自动功能流程图的顺序编写的自动程序梯形图为图4-6。

16

17