MOTOMAN工业机器人实时控制平台研究

MOTOMAN工业机器人实时控制平台研究

0引言

MOTOMAN工业机器人的运动控制和程序编制一般是通过示教盒来实现，其功能相对比较简单，控制范围半径较小，在恶劣的环境下，其作用就会受到限制。随着计算机技术高速发展和工业自动化水平不断的提升，实时控制系统的研究成为机器人技术研究领域的一个热点。主控计算机可通过控制系统的人机控制界面直接对机器人进行控制，可加大原有对机器人的控制范围，给操作人员创造了一个良好、安全的操作环境。本文以MOTOMAN-UP6机器人为对象，采用VC++语言开发了工业机器人实时控制平台，为实现基于视觉技术的机器人搬运，分拣等实时控制作业打下了重要的基础。

1机器人实时控制系统的组成与模块设计

这里研究的工业机器人实时控制系统由主控计算机，UP6机器人、YASNAC．XRC控制柜和摄像头组成，如1，UP6机器人具有S，L，R，U，B和T六个转动关节。由于YASNACXRC控制柜不支持以太网通信，因此，工业机器人通过标准的RS232串口和主控计算机进行通讯，可以向工业机器人发送控制指令或作业程序，安川机器人维修，并接收机器人反馈信息。本文研究的机器人实时控制平台主要有状态命令、操作命令和其他功能三个模块组成，采用VisualC++6.0语言设计的UP6机器人实时控制的软件界面设计如2所示。

1工业机器人控制系统组成

2UP6机器人实时控制软件主界面

(1)状态命令模块

上伺服和下伺服功能实现了对伺服电源的通断控制，示教模式和运行模式功能实现了对示教状态的选择控制，回位功能实现了机器人各关节回到起始位置的状态，即机器人各关节转角为零的状态。

(2)操作命令模块

关节脉冲式和关节坐标式功能模块都可以控制机器人以某一速度用关节的插补方式运动到某一位姿。前者用六个关节的脉冲数描述位姿，后者用直角坐标值即(X，Y，Z，RX，RY，RZ)描述位姿。同理，直线脉冲式和直线坐标式模块都可以控制机器人以某一速度用直线的插补方式运动到某一位姿，前者用六个关节的脉冲数描述位姿，操作对话框如3，后者用直角坐标值(X，Y，Z，RX，RY，RZ)描述位姿，操作对话框如4。

3直线脉冲式操作对话框

4直线坐标式操作对话框

单步运行功能模块是对UP6机器人功能的扩展，根据操作者设定的运行参数，可实现对机器人末端执行器直角坐标系下单个自由度方向的运动控制，或关节坐标方式下单个关节的运动控制。程序运行功能模块可使传送文件功能实现的机器人控制柜中的作业文件执行。

(3)其他功能模块

传送文件功能模块可将操作者选择的MOTOMAN工业机器人可执行JBI格式文件下载到执行机器人控制柜中。接收文件功能模块可将器人控制柜中可执行程序JBI格式文件上传到主控计算机中．实现了计算机与机器人之间的高速数据交换以及对控制柜中作业文件的管理。

视频功能模块功能采用像监控手段可实时显示机器人的操作画面，便于操作者对机器人进行远距离控制，避免与机器人同在一些恶劣环境下工作，同时也是采用视觉技术进行搬运和分拣等实时控制的重要准备。

2MOTOCOM32库的面向对象封装

MOTOCOM32是日本安川电机公司为其MOTO．MAN系列机器人提供的软件开发工具包，包含了文件数据传送功能，机器人控制功能和I/O读写信号功能等，用户可根据实际要求情况进行开发，实现所需控制功能。MOTOCOM32本质为动态链接库(DLL)，用VC++语言进行开发时，首先应在ProjectSetting/Link对话框中的L对象/库模块输入框中添加Motocom32.1ib库文件，如5，然后将mo．tocom32.h与motocom32.dll拷贝到工程目录内。

5VC++中使用MOTOCOM32库

MOTOMAN公司虽然给用户提供了库手册，但说明比较简单，尤其对函数的使用方法介绍不多，同时为了避免运动控制函数的非阻塞性导致程序出错的问题，本文对MOTOCOM32库部分功能采用了面向对象的封装，公开接口如表1所示。应用面向对象封装后，更换不同类型的工业机器人，只需替换类文件，保持公共接口不变，就可以有较好的适应性。

3机器人实时控制平台程序的编制

单步运行功能模块充分体现了控制平台的实时性，是本文控制平台开发的重点之一。现以S轴为例来说明各个轴的具体运行操作方法，以下是此功能需要调用的主要函数：

OnButtonSl()函数和OnButtonS2()函数均要调用OnOpenCom()函数。在OnButtonSl()函数运行的同时，OnSetposSl()函数同时运行，显示s轴正方向运动的当前脉冲数值和进度；OnSetposS2()显示s轴反方向运动的当前脉冲数值和进度。系统调用OnSelect()函数表示选择脉冲和角度的功能，同时OnSelect()将参数传到OnButtonSl()或OnButtonS2()供其调用。

由于篇幅关系，这里只给出S轴正向运行的源程序。

4MoTOMAN机器人实时控制平台的测试

点击主界面的传送文件按钮，弹出对话框，如6，选择计算机上的MOTOMAN机器人JBI格式作业文件。然后点击执行按钮，弹出传送成功的提示。点击主界面的接收文件按钮，可以看到刚才传送到XRC控制柜的机器人作业文件，选择计算机接收文件的存储路径，然后点击执行按钮，弹出接收成功的提示，根据刚才选择的存储路径，便可找到刚剐接收的的机器人JBI格式文件。至此表明已成功建立了主控计算机、YASNAC-XRC控制柜和MOTOMAN-UP6机器人三者之间的通信，体现了计算机与机器人控制柜高速数据交换功能。

6传送文件对话框的操作

点击主界面的单步运行按钮，弹出对话框如7，首先选择脉冲或角度为运行单位，然后输入关节运动的速度值，脉冲值或角度值，然后就可选择各个关节进行操作。点击+按钮表示为对应关节正向运动，-按钮表示反向运动，机器人维修，操作的同时可观察到UP6机器人也实现对应控制关节的转动，同时对话框7显示对应关节已运行的脉冲数和进度，显示的比值表示当前运行脉冲数占运行到极限位置脉冲数的比例。彩色进度条韵红颜色为警戒位置，表明关节运动接近极限位置，提醒操作人员停止操作。如果操作者输入的值超过了对应关节运动范围，本系统禁止执行并将提示出错。

7单步运行对话框的操作

在单步运行功能中选择各个关节进行操作的同时，可点击主界面的视频1按钮，ABB机器人维修，打开视频，如8，通过视频可直接观察UP6机器人的作业状态。

8视频功能的模

5结束语

本文研究的工业机器人实时控制平台可以进行远距离控制，改善了操作者的示教编程环境。具有像实时监控、速度控制和高速数据交换等功能，实现了实时单步运行控制，进行了关节运动转角范围设置，操作更具安全性。为基于视觉技术的搬运。分拣技术等实时控制的研究打下了重要的基础。应用面向对象的技术对MOTOCOM32库进行封装后，提高了MOTOCOM32库的易用性，降低了编程难度，同时可以较好的适应其他类型的工业机器人。具有较强的通用性。