基于PMAC的开放式工业机器人运动控制数据实时采集研究*

王进华（1.华南理工大学 计算机科学与工程学院，广东 广州 510006；2.罗定职业技术学院 电子信息系，广东 云浮 527200）

基于PMAC的开放式工业机器人运动控制数据实时采集研究*

王进华1，2
（1.华南理工大学 计算机科学与工程学院，广东 广州 510006；2.罗定职业技术学院 电子信息系，广东 云浮 527200）

实时数据采集与通信子系统是工业机器人运动控制系统的基本环节，PMAC卡作为底层控制器在工业机器人运动控制中广泛应用。根据数据采集源、与上位机通信模式，对基于PMAC的数据采集方法进行分析，确定在线指令方式进行数据采集，定制了基于网口的开放通信模块。在实现过程中采用了软件模块化、多线程、定时器、双缓存等技术实现指令编码、数据采集与解码。测试结果证明了通信与采集子系统的稳定性和实时性。

PMAC；开放控制；数据采集；实时性；机器人

0 引言

在工业控制领域，实时数据采集是一个基本而且重要的环节，如何提高数据采集的实时性一直是工控技术人员所关心的问题［1］。多轴运动控制卡（Programmable Multi-Axis Controller，PMAC）集执行程序（运动程序和PLC程序）、数据采集、伺服环更新、资源管理等多个模块一起协同工作，在工业机器人的运动控制中得到广泛应用［2］。

1 基于PMAC的数据采集分析

PMAC通过对机器人关节的4路数字信号解码得到该关节的位置、速度、加速度等数据源，上位机采集这些数据进行运动学和动力学运算得到机器人实时的位置和运动信息。数据采集涉及数据采集源、通信模式、采集方法、数据解码、人机交互［3］等。

数据采集源指被采集的数据在卡上存储的对象，主要有PMAC缓冲区、寄存器、双端口RAM。

PMAC主卡与上位机之间的通信模式有104总线接口、USB2.0以太网口、RS232串口等。

结合通信模式和数据采集源，基于PMAC数据采集有双端口 RAM、Gather功能寄存器、PLC程序M变量、在线指令等采集方法。基于双端口的数据采集从双端口RAM中采集数据，不需要经过通信口发送命令和等待响应时间，实时性较好。基于Gather功能的数据采集从缓冲区采集数据，需要使用PMAC的通信驱动和Gather类函数，适合于大量信息进行数据采集［4］。基于PLC程序和在线指令的数据采集从I/O及运动寄存器获取数据，需要使用PMAC的通信驱动和软件定时器。基于在线指令的数据采集可以实时单点采集，也可以循环采集，而且可以基于以太网口定义开放式通信接口，独立于PMAC驱动程序。

2 基于多线程技术和在线指令的实时数据采集

2.1 多线程技术

多线程编程技术应用于机器人控制，可在收发数据的同时进行数据的处理、状态切换、屏幕刷新等任务，提高程序的实时性和软件的整体性能［5］。本控制系统采用多线程技术实现，提高了数据采集的实时性，系统程序结构如图1所示。

图1 系统程序结构图

2.2 数据采集的编码实现

本文基于在线指令进行数据采集，自定义通信接口。

2.2.1 开放式通讯接口

目前所见的基于PMAC的机器人开放式运动控制器都利用了Delta Tau公司提供的PComm32PRO通信驱动程序，限制了控制器的开放性。为了支持嵌入式实时操作系统的应用开发，采用C++设计了PMAC开放式网口通信服务，供上层服务通过socket调用，数据规范如下：

2.2.2 数据采集的编码实现

PMAC指令以及回传的运动参数都是字符串，需要进行指令编码和数据译码。

在嵌入式应用环境中进行数据循环采集需要预防产生内存泄露的情况发生，优化内存资源。

2.3 控制系统平台构建与轨迹跟随测试

2.3.1 控制系统平台构建

MOTOMAN、SEIKO等均把基于PC的机器人控制器作为发展方向［6］，主要形式有：

·工控机+接口卡。接口卡不带处理器，将各关节运动数据送入工控机，经伺服程序计算得到伺服电机的控制量［7］，这种方式构建的系统具有很高的灵活性和扩展性，但开发难度比较大。

·工控机+运动控制卡。以DSP为核心的运动控制卡可以集多轴实时伺服运动控制于一卡，并有函数库供用户在工控机上构建所需的控制系统，工控机主要完成系统管理、状态监控、运动规划等上层任务［8］。

本文采用工控机+多轴运动控制卡（PMAC）作为机器人控制器，硬件原型如图2所示。

图2 开放式工业机器人控制平台原型

为了满足机器人控制实时性要求，工控机需要运行实时操作系统，如Windows CE等，或采用通用Windows操作系统+实时扩展环境RTX，可以利用Windows操作系统完备的软件开发环境和丰富的软件资源［6］。本控制器硬件采用研祥EC3-1711CLDNA工控机，其CPU是Genuine Intel（R）processor600MHz，内存为480MB，存取速率为599MHz，硬盘为80GB，操作系统采用Windows XP+RTX。

2.3.2 系统测试

为验证控制平台和数据采集的有效性，采用两关节模拟工业机器人和静态PID进行测试。轨迹跟随测试的软件流程和测试结果如图3和图4所示，关节实时跟随位置如表1和2所示。

图3 轨迹跟随软件流程

图4 圆弧轨迹跟随效果

表1 1号关节数据采集与分析

3 结论

本文从数据采集源、通信模式、采集方法等对基于PMAC的开放式数据采集系统进行对比分析，完成通信接口、指令编码数据解码等的模块化设计和封装，采用多线程技术优化性能。硬件平台的两关节机器人轨迹跟随测试的关节空间和笛卡尔运动空间的试验数据验证了控制系统及数据采集子系统的有效性。

［1］林延昌，鱼洋，沈跃.基于PMAC控制卡的机器人控制软件设计［J］.计算机测量与控制，2005，13（8）：854-857.

［2］张东衡，徐秀林，张佳鸣.人工心脏瓣膜体外检测装置软件开发［J］.计算机测量与控制，2008，16（8）：1197-1198.

［3］王进华，曾凌峰，张勤利.数字电视机顶盒人机交互组件的设计与实现［J］.微型机与应用，2011，30（20）：96-98.

［4］郑存红，胡荣强，赵瑞峰，等.用VisualC++实现实时数据采集［J］.计算机应用研究，2002，19（4）：103-108.

［5］曾欣.多线程机器人控制软件的设计［J］.科技广场，2011 （11）：100-103.

［6］DELTA TAU Data Systems，Inc.PComm32PRO installation and troubleshooting procedures，Versions10.45（PRO Suite 2.0）and later［S］.

［7］张广立，付莹，杨汝清，等.基于 Windows NT的开放式机器人实时控制系统 ［J］.上海交通大学学报，2003，37 （5）：724-728.

［8］马琼雄，吴向磊，李琳，等.基于IPC的开放式工业机器人控制系统研究［J］.机电产品开发与创新，2008，21（1）：15-17.

Study of industrial robot′s real-time data gathering based on PMAC

Wang Jinhua1，2
（1.School of Computer Science＆ Engineering，South China University of Technology，Guangzhou 510006，China；2.Department of Electronic Information，Luoding Polytechnic，Yunfu 527200，China）

Real-time data acquisition and communication subsystem are basic aspects of the industrial robot motion control system，and the PMAC card as the underlying controller is widely used in industrial robot motion control.According to the data collecting sources and the different communication modes between host and PMAC，we selected the online command for data collecting，and customized open communication module based on Ethernet port.In the implementation process，we used software modularity，multi-threading，timers，and double-buffering technology to achieve instruction encoding，data acquisition and decoding. The test results proved the performance of stability and real-time for communication and acquisition subsystem.

PMAC；open control；data gathering；real time；robot

TP2

A

1674-7720（2015）20-0061-03

王进华.基于PMAC的开放式工业机器人运动控制数据实时采集研究［J］.微型机与应用，2015，34（20）：61-63，66.

2015-05-20）

王进华（1977-），男，博士，主要研究方向：基于 SOA的开放式控制软件。

广东省高职教育教师教育委员会2013年度基金项目（2013G13） ；广东省教育研究院2014 基金项目（GDJY-2014-B-b242）