直角坐標机械手伺服驱动系统的研究.docVIP

随着加工行业在我国的迅速发展，各行各业的自动化装备水平越来越高，现代化加工车间，常常配有机械手，以提高生产效率，代替工人完成恶劣环境下危险、繁重的劳动。???? 目前，机械手常用于完成的工作有:注塑工业中用于从模具中快速抓取制品并将制品传送到下一个生产工序; 机械加工行业中用于取料、送料; 浇铸行业中用于提取高温熔液等等。本文以能够实现这类工作的搬运机械手为研究对象，针对本文作者参与的工业取料用直角坐标机械手控制系统软、硬件进行了介绍和分析。???? 目前市场上常见的工业取料直角坐标机械手主运动臂的控制方式主要采用液压或气压驱动。这种控制策略的优点在于结构简单，系统易于控制。但缺点是系统定位靠设定接近开关的位置来实现，定位精度低，而一但用户要求改变取料工作类型，必须重新调节各液压或气压缸的定位开关，以适应新的工作任务，不利于生产过程的自动化。???? 本文作者参与设计的工业取料用直角坐标机械手，主运动采用全电动控制方式，系统以交流电机为驱动源，专用交流电机伺服控制器为下位机，工业控制计算机为上位机，系统整体采用集散控制的控制策略。这种设计方案系统控制精度高，具有较高的控制实时性，结构紧凑，易于用户操作。 系统结构???? 工业取料机械手的工作方式是按“示教/ 再现机器人”的概念来完成的，即由人用示教器对机械手的工作行为示教，示教过程中记录机械手各运动关节起始点位置，并在生产过程中按用户设定的运动速度、加速度重复这一动作过程。根据以上分析，我们设计出了一类主运动为全电动的工业取料机械手。机械手控制系统采用集散控制结构，即由一台上位机控制五台下位伺服控制器，每台下位伺服控制器单独驱动一台交流异步电动机，电动机带动机械手的执行机构完成动作。???? 本系统上位机选用工业控制计算机，下位伺服控制器采用交流异步电动机专用伺服控制器，上位计算机通过串行口，按RS-485协议标准与伺服控制器进行通讯，下位机接受上位机发出的指令语言，按指令要求控制电机转动。同时下位伺服控制器还通过交流电机上的码盘检测异步电机运动状态，并反馈给下位机，以实现下位控制器对电机运动状态的实时控制。控制系统结构如图1。 图1:机械手控制系统结构图 ???? 机械手的未端执行机构采用气动驱动，以完成手指的捏合、翻板的翻转、及翻板上真空吸盘的吸放动作。交流异步电机伺服控制器是一类专门用于控制交流异步电机的设备。交流异步电机伺服控制器采用转差型异步电机矢量变换控制方法。这种矢量控制系统模仿了直流调速系统的控制方式，外环转速闭环控制是建立在取向于转子磁链方向的同步旋转坐标系上，然后通过矢量旋转变换将直流控制量的电流变换到定子静止坐标系上，得到定子两相交流电流量，再经2/3相变换获得定子三相交流电流量。???????? 电机的测速码盘是交流异步机伺服控制器的辅助设备，码盘装在电机轴的尾部，随电机轴一起转动，码盘的信号线接入伺服控制器的专用输入口，为伺服控制器提供电机转速信号，作为矢量变换的反馈参数。??? 伺服控制器配有RS-485 接口，用于与上位机通讯。通过使用伺服控制器的专用语言，我们设计了运行于伺服控制器上的程序。下位伺服控制器在上电后自动执行存储于控制器中的这段程序。它的主要功能是接受上位计算机下传的指令，按上位计算机的要求对电机运动状态进行控制。对于电机运动的具体实时控制则由下位伺服控制器的内部控制算法实现。 软件实现方式???? 因程序涉及的细节较多，这里我们重点介绍上位计算机程序的示教/再现实现方式。上位计算机的程序采用了C++语言，针对五个下位控制器我们设计了一个专门用于控制下位伺服控制器的类，在主程序中，这个类生成了五个对象。这个类构造函数的参数包括每个下位控制，如每个控制器的编码，每个控制器在软件界面上相应控制按钮的标识，每个控制器的I/O 地址，每个控制器相应电机运动方向上接近开关地址，每个控制器的速度级等等。因为除了这些属性不同以外，每个控制器的其它属性和要实现的函数是相同的。在示教过程中，程序会根据用户对界面上各按钮的操作，即机械手的示教过程形成一个数据队列，这个数据队列的每个数据记录结点内包含一个Recorder类的对象。这个类用于记录相应动作的信息，即动作的所有者，动作的位移量，动作的完成状态等等。这样就完成了一个示教过程的记录，并形成数据记录队列。图2所示即为形成的数据记录队列的结构形式，队列头是数据记录的起始点，队列尾是数据记录的结束点。 图2:数据队列的结构形式 ???? 在实际工作过程中, 程序通过依次读取这个数据队列，得到当前应当启动的动作信息，并按这一数据通知下位计算机, 启动相应动作，一个或几个动作完成后，继续处理下一数据记录，直到到达数据队列的队尾，这样就完成了一个示教过程的动作再现。程序