基于嵌入式PC的工业机器人开放式控制系统交互控制的实现

基于嵌入式PC的工业机器人开放式控制系统交互控制的实现

0引言

多自由度关节型工业机器人应用范围涉及到焊接、搬运、喷涂、浇铸等各方面，对于不同的应用，关节型工业机器人的自由度数量、对应的外部系统交互控制信号的需求等都各不相同。因此，其控制系统必须具有开放性、通用性，对于不同的应用，可以根据需要来选配相关的硬件设备，并提供外部系统交互信号的通路；同时能够根据需要增减、修改相应的软件功能模块，以满足不同工业机器人及其自动化系统交互控制的需求。鉴于工业PC强大的处理能力及其良好的通用性。越来越多的机器人采用工业PC作为控制系统的核心控制器。而对于不同系统之间的交互控制，系统之间的信号交换多采用开关量或现场总线通信的方式来实现。现场总线通信方式传递的信息量大，适合复杂的多机协调控制，但其实现的难度大，成本高；而采用开关量交换信号简单易行，能满足大多数工业机器人交互控制的应用需求。因此，本文选用嵌入式x86工业PC作为工业机器人控制系统的核心控制器，系统通过开关量与外部系统进行信号交换，交互信号在机器人系统内部通过共享内存的方式进行传递，从而以相对简单的方式实现工业机器人系统的交互控制。

1工业机器人开放式控制系统结构原理

1.1系统硬件结构

本文所设计的开放式机器人控制系统的硬件系统基于嵌入式x86工业PC实现，主要包括RC控制器、人机接口(HumanMachineInterface，HMl)、伺服驱动系统等三大部分。其硬件系统的体系结构如1所示。

1控制系统硬件体系结构

系统的RC控制器以嵌人式x86工业PC+FPGA的方式实现，嵌入式x86工业PC是整个系统的控制核心，所有的数据及信号处理均由它完成；嵌入式x86工业PC通过PCI04总线与FPGA模块进行通信；FPGA模块实现与伺服系统、外部I/O信号、操作面板等的接口功能，为工业PC与外部的各种信息和数据的交换提供通路。

伺服驱动系统由多个独立的伺服单元组成，每个独立的伺服单元由一个带标准脉冲指令接口的伺服驱动器及一个伺服电机组成，每个伺服单无对应机器人一个关节轴，关节轴数量可以根据实际需要灵活配置，系统最多可配置8个关节轴。系统共有48路输入、32路输出信号，为保证系统的町靠性，提高系统抗干扰能力，I／O信号的接口均采用光电隔离的方式。HMI包括操作面板、显示器和各种通信及数据交换接口等，可实现友好的人机交互功能，并能方便地与外部系统进行通信及数据交换。

1.2系统软件结构

系统采用RT-Linux作为软件平台，系统软件的实时操作环境在RT-Linux操作系统上扩展而成。整个软件系统分为3层：系统层、控制层和应用层。软件系统结构如2所示。系统层主要包括RT-Linux操作系统、设备驱动程序和RTMS实时多任务调度程序等3部分。设备驱动程序主要是满足不同的控制对象(即不同自由度的工业机器人)在使用不同的硬件配置时对不同驱动程序的要求，以实现系统的通用性。RTMS模块是自主开发的装载于RT-Linux实时内核上任务调度器，它实现对机器人控制系统的任务管理调度。控制系统将应用层和控制层的各个程序模块的任务按其不同的实时性要求划分调度优先级，以满足RTMS模块调度功能的需求。

2控制系统软件体系结构

控制层为实时域，KUKA机器人维修，系统的全部实时控制功能均在控制层实现。控制层软件根据控制功能的不同进行模块化设计，主要包括插补运算、逆运动学、位姿控制、PLC控制等软件模块。

应用层为非实时域，也采用模块化编程的方法进行设计，应用层功能软件模块有人机界面、动态显示、程序编辑、译码解释、轨迹规划、故障诊断、通信管理等。系统提供了对用户开放的应用层控制软件接口，具备了方便的二次开发环境，能灵活地组配不同类型的机器人控制系统和扩充系统功能，具有很好的开放性和町维护性。对于不同的工业机器人对象，其系统功能的区别和增减均在应用层实现。

2系统交互控制机理

机器人控制系统内、外部信息的交换机制，是实现系统交互控制的关键所在。控制系统内部信息交换可以有多种方式实现，本系统中内部信息的交换通过共享内存的方式来实现。系统中内、外部开关信号的交换也是采用共享内存的方式来实现的，在共享内存中定义不同的寄存器来实现不同控制信号的传递，系统内、外部开关信号交巨机制如3所示。

3系统内、外部开关信号交换机制

各寄存器功能定义如下：

l寄存器为系统外部输入给PLC的开关信号，PLC程序通过读I寄存器获取外部输入信号；

L寄存器为PLC输Hj给外部系统的开关信号，PLC程序通过写L寄存器输出控制信号；

R寄存器为PLC内部中间寄存器，可由PLC软件任意使用；

P寄存器为PLC外部参数，可由PLC程序与机器人用户任意自行定义，从而实现机器人用户与系统之间的信号交互；

S寄存器为PLC输出给机器人系统内部的信号；

C寄存器为机器人系统内部输出给PLC的信号。其中：S、C寄存器由数控系统与PLC事先约定好的，PLC硬件和软件都不能更改其寄存器各位的定义。

本系统控制软件中的PLC控制程序模块的主要任务是实现对系统内外部输入、输出的开关鼋信号的逻辑控制。在机器人控制系统与外部系统进行交互式控制时，所有的交互控制信号都由PLC控制程序进行处理，在PLC程序中根据控制的不同需求定义不同的M指令，每一条M指令控制一个或多个内、外部开关信号，用户进行机器人编程时，在需要实现交互控制的动作语句后而插入对应的M指令，ABB机器人维修，系统通过执行M指令来读写相关寄存器的值，从而完成相关控制信号在系统内部的传递，实现本系统与外部系统的交互控制功能。

3系统应用及其交互控制的实现

本文设计的控制系统已经成功应用于东风汽车公司某厂的三轴浇铸机器人系统的控制，实现了机器人系统与两台浇铸机系统的交互控制，系统应用实物如4所示。

4控制系统应用实例

3.1应用对象控制功能需求

如4所示，本应用案例中机器人系统与2台浇铸机系统之间必须进行交互控制，工作时机器人运动过程如5所示。

5浇铸机器人运动过程示意

浇铸所用容器安装于机器人末端，机器人容器初始位置(零点)为废料箱正上方，当系统以熔炉1供料时，机器人浇灌1号浇铸机时运动过程为：

a→等待→b→浇灌→c→除废料→a

机器人浇灌2号浇铸机时运动过程为：

a→等待→d→浇灌→e→除废料→a

机器人末端容器从废料箱正上方水平运动到熔炉1上方暂停，等待任意浇铸机发送准备好信号给机器人系统；浇铸机X(1或2)准备好后，给机器人系统发送浇铸机X准备好信号，机器人系统检测到此信号后，从炉1内舀出液态金属，运动到浇铸机X处对其进行浇灌；浇灌完毕后，给浇铸机X发送x号机浇灌完成信号，浇铸机x收到此信号后开始工作，同时，机器人容器移动到废料箱下方，机器人系统清除x号机浇灌完成信号并暂停5s，由机器人控制系统通过外部I／0控制吹风机将容器内的废料清除，废料清除完毕后，机器人重复运动过程a，容器回到熔炉l上方，等待下一次浇铸机准备好信号。机器人的等待、浇灌、除废料等工作状态，都需要与浇铸机及其他相关辅助设备(如吹风机)进行交互控制才可实现。