1  引言

　　机械手是一种能模拟人的手臂的部分动作，按预定的程序轨迹及其它要求，实现抓取、搬运工作或操纵工具的自动化装置。而可编程逻辑控制器(PLC)由于其具有的高可靠性、编程方便、易于使用和修改、易于扩展和维护、环境要求低、体积小巧、安装测试方便等性能在工业控制中有着广泛的应用。根据我们所设计的机械手的驱动部件为步进电机驱动器的特点，我们采用了日本OMRON公司生产的位置控制单元模块NC111CONTROL ENGINEERING China版权所有，用来产生脉冲和方向电平，来控制机械手的运行。

点击看原图

　　图1   四自由度机械手限位开关示意图

　　2  四自由度机械手的结构及运动

　　四自由度机械手为圆柱坐标型，可实现X轴伸缩、Z轴升降、底盘、腕回转功能。驱动全部采用步进电机控制，夹爪采用气动方式控制。机械手主要完成从3台辊道输送带到立体仓库出货台之间的货物传递。

　　(1) 四自由度机械手主要性能指标

　　X轴:最大移动距离420mm

　　Z轴:最大移动距离420mm

　　底盘回转:最小控制转角0.09°，最大回转角小于等于300°

点击看原图

图2   机械手工作的电路原理图

　　图1为四自由度机械手的限位开关示意图，其中SQ1~SQ7为限位开关。其作用是保护运行时不会因为过限而造成机械上的损坏。

　　(2) 运动流程根据实际需要而定，如上升嘧笮朽逆时针旋转嘧ナ肿ソ羿下降嘤倚朽顺时针旋转嘧ナ址潘舌返回，还可以有其他工作流程。

　　3  机械手的工作原理

　　机械手的伸缩、升降、转盘、抓手的运动是由步进电机驱动器来控制的，型号为SH-2H057。其步进电机驱动器的输入脉冲和电平信号是由PLC上的NC111模块来提供的。其电路原理图如图2所示。

点击看原图

　图3   CP的脉冲宽度以及高低电平方式

　　(1) 步进电机驱动器

　　本驱动器的输入信号共有3路，分别是:步进脉冲信号CP、方向电平信号DIR、脱机信号FREE。它们在驱动器内部分别通过270Ω的限流电阻接入负输入端，且电路形式完全相同。OPTO端为3路信号的公共正端(3路光耦的正端输入)，3路输入信号在驱动器内部接成共阳方式，所以OPTO端须接外部系统的VCC，如果VCC是+5V则可以直接接入;如果VCC不是+5V则需外部另加限流电阻R，保证给驱动器内部光耦提供8-15mA的驱动电流。

　　a)  步进脉冲信号CP

　　步进脉冲信号CP用于控制步进电机的位置和速度，也就是说CONTROL ENGINEERING China版权所有,驱动器每接受一个CP脉冲就驱动步进电机旋转一个步距角，改变CP脉冲的频率,能改变步进电机的转速，控制CP脉冲的个数，则可以使步进电机精确定位。这样就可以很方便的达到步进电机调速和定位的目的，本驱动器的CP信号为低电平有效，要求CP信号的驱动电流为8-15mA控制工程网版权所有，对CP的脉冲宽度也有一定的要求，一般不小于5μSCONTROL ENGINEERING China版权所有，如图3所示。

　　b) 方向信号DIR

　　方向电平信号DIR用于控制步进电机的旋转方向。此信号为高电平时，电机正转;为低电平时，电机反转。电机要转向，必须在电机停止以后进行，如图4所示。

点击看原图

　　图4   方向信号DIR

点击看原图

　　图5   NC111的结构框图

　　c) 脱机电平信号FREE

　　当驱动器上电以后www.cechina.cn，步进电机处于锁定状态(未施加CP脉冲时)或运行状态(施加CP脉冲时)，可以用FREE信号,手动调整电机而不关闭驱动器。

　　(2) NC111模块的工作原理

　　C200-NC111是C200PC用于位置控制的智能单元。它可以为步进电机驱动器或伺服电机驱动器输出脉冲，以控制运动部件的位置和速度。

　　a) 性能指标

　　l 每个单元可以控制一个轴;

　　l 输出控制脉冲:-8388607~+8388606;

　　l 脉冲速率:1~99990个/s;

　　l 脉冲速率得变化:控制系统可实现阶梯式自动加减速,加速度为每毫秒1~999每秒脉冲;

　　l 原点搜索:可监测原点或原点信号;也可进行原点补偿0~9999个脉冲;也可高速或接近现有速度搜索原点;

　　l 间隙补偿:0~9999个脉冲;

　　l 手动操作:可高速点动，低速点动和微动;

　　l 多点定位:可一次定位20点，以15种速度变化;

　　b) 系统配置

　　图5为NC111的结构框图。

　　位控单元有自己的微处理器和存储器，还有脉冲发生器和I/O接口。位控单元既可以被PC主CPU单元控制，也可以直接