基于PC机的工业机器人控制平台

基于PC机的工业机器人控制平台

0引言

随着机器人技术的发展和丁业自动化水平的提高，丁业机器人已成为柔性制造系统中的重要设备之一，实现主控计算机对丁业机器人的通信和控制，是当前该领域的一个研究热点。文献设计了一个基于网络的机器人控制系统，实现了对机器人六个关节的状态读取和运动控制，但控制系统的功能比较单一。无法对机器人进行其他的控制操作。文献通过视觉反馈系统和离线示教仿真机器人，实现了对本地服务机器人的运动控制和示教编程，但操作者只能采用关节控制方式和默认的运动插补方式来控制机器人的运动。基于RS232串口通信，文献实现了对机器人单个关节的运动控制和对手腕的直角坐标控制，文献实现了对搬运机器人行走和机械手爪抓取的一系列控制。但这些控制过程只能单步运行，不能编辑成完整的作业程序，而且运行速度和插补方式也无法由操作者自己设定。此外，上述机器人控制系统仅局限在实验教学领域，难以满足实际工业生产中对机器人的控制需求。为了提高机器人控制系统的实用性，本文结合实验室现有的MOTOMAN-UP6机器人，开发了一个符合实际生产需求的工业机器人控制平台。

1系统的组成和工业机器人控制平台的功能设计

本文研究的工业机器人控制系统主要由PC机、MOTOMAN-UP6机器人、YASNAC．XRC控制柜和摄像头组成。由于YASNAC．XRC控制柜只提供了RS232串口，因此，PC机与YASNAC．XRC控制柜采用串口通信线连接。整个工业机器人控制系统的结构如1所示。

1机器人控制系统的结构

工业机器人的示教盒向操作者提供了控制机器人的界面和机器人的实时状态信息，因此，目前操作者对工业机器人的运动控制和程序编制等操作基本都是在示教盒上完成的。但是，示教盒作为操作机器人的手持终端，其显示屏和按键区域就不能做的过大，而且，在示教状态下对机器人进行运动控制时，操作者必须一直按住伺服电源启动键，这些限制都给操作者带来诸多不便。为了摆脱示教盒的束缚，使操作者可以方便地在PC机上实现对工业机器人的直接控制，本文设计了一个工业机器人控制平台。该平台主要包含以下五个模块：

(1)控制管理模块

主要功能有建立通信、断开通信、接通伺服和断开伺服，实现了PC机与机器人控制柜之间的通信管理，以及对伺服电源的通断控制。

(2)视频监控模块

当视频设备与PC机连接成功后，该模块可以实时显示机器人的现场工作画面，便于操作者监控机器人在示教编程和执行作业文件时的运动情况。该模块还可以允许操作者设置像的来源、格式和单帧拍摄，以及进行视频录制和视频压缩设置等。

(3)文件管理模块

当PC机与机器人控制柜建立通信后，该模块可以显示机器人控制柜中的作业文件列表，并提供了机器人作业文件的上传、下载、删除和运行功能，实现了作业文件在Pc机与机器人控制柜之间的高速交换，以及对机器人控制柜中作业文件的管理。

(4)机器人运动控制模块

该模块包含了对机器人的单步控制、六轴联动控制、机器人末端位姿显示、各关节的脉冲显示和角度显示。操作者可以根据自己的要求，设定插补方式(有关节插补或直线插补两种方式可供操作者选择)、单步增量方式(有角度增量、脉冲增量和位移增量三种方式可供操作者选择)、单步增量的具体数值和运行速度的具体数值。

1)单步控制功能：可以根据操作者设定的运行参数，在直角坐标方式下，实现对机器人末端执行器单个自由度方向的运动控制，或在关节坐标方式下，实现对机器人单个关节的运动控制；

2)六轴联动控制功能：根据操作者设定的运行参数和目标点位姿，实现对机器人六个关节的联动控制，并且设置了复位按钮，方便操作者对机器人进行复位操作；

3)机器人末端位姿及各关节脉冲、角度显示功能：通过读取机器人的当前位置和姿态，实时显示机器人的末端位姿信息，以及各关节的脉冲和角度信息。

(5)示教编程模块

使操作者能够在安全的编程环境下，轻松地编写和修改机器人的作业文件，主要具有以下功能：

1)运动指令语句的添加、删除和清除功能，并反白显示刚刚添加的运动指令语句，或者反白显示删除语句上一行的运动指令语句；

2)在示教编程器中双击某一行运动指令语句或控制语句，就可以对该行语句进行替换修改，或者在该条语句之后添加一行控制语句；

3)保存JOB文件按钮用于保存示教编程生成的机器人作业文件，保存后的作业文件可通过文件管理模块下载到机器人控制柜中；

4)机器人随动功能，用于再现与某一行运动指令语句对应的机器人位姿，当选中机器人随动功能后，鼠标左键单击到哪一行运动指令语句，机器人就以该语句设定的插补方式和运行速度运动到指定的位姿点。

2工业机器人控制平台的程序编制

2.1MOTOCOM32库的面向对象封装

本文利用MOTOMAN机器人的软件开发工具包MOTOCOM32，在VC++6.0平台上开发MOTOMAN机器人的控制平台，工业机器人维修，然后根据RS232串口通信协议，实现PC机对MOTOMAN-UP6机器人的控制。在VC++6.0中使用MOTOCOM32的方法可参考文献，在其它编译器中使用MOTOCOM32的方法与此相似。

由于安川电机公司提供的库手册中，对于一些函数的使用方法介绍不是很详细，而且，子锐机器人维修，运动控制函数的非阻塞性，会导致某些指令序列在执行过程中出错。为提高MOTOCOM32库的易用性，解决非阻塞函数在使用过程中产生的问题，本实验室采用面向对象技术对MOTOCOM32库进行封装。

在此之前，已经完成了MOTOCOM32部分功能的面向对象封装，并提供了封装之后的公开接口。本文在此基础上，对另外一些常用功能进行了面向对象封装，充实后MOTOCOM32封装库的公开接口如表1所示。

2.2程序代码的编写

完成MOTOCOM32库的面向对象封装之后，就可以利用这些公开接口编写MOTOMAN机器人控制平台的代码程序，其中，示教编程模块是控制平台开发的重点功能之一。本文使用列表框控件作为示教编程器的主体部分，用于显示作业文件中的运动指令语句和控制语句。为记录运动指令语句的编号、插补方式、运行速度、关节电机的脉冲数，以及控制语句的在指令体中的位置，本文根据这些参数对整个作业文件进行划分，每种参数都在程序后台由对应独立的数组来记录，当添加或删除一行运动指令语句或控制语句时，对应数组内的存储数据也会发生相应的变化。

运动指令语句或控制语句的替换修改功能和机器人随动功能，分别通过列表框控件的双击响应函数和单击响应函数来实现。实现机器人随动功能的主要代码如下：

3工业机器人控制平台的实现与测试