基于PMAC的工业机器人示教再现程序的研发

基于PMAC的工业机器人示教再现程序的研发

机器人语言是机器人系统先进水平的重要标志之一。国内工业机器人的研究采用的运动控制卡大部分都从欧美等国外引进，现有国内自主研发的控制卡还远远没有满足工业机器人的要求。在研制的机器人中，采用的PMAC是从美国引进的。其性能比以往控制卡有很大的改进，在运动控制方面更是表现出极佳的性能。

目前，大多数工业机器人的基本操作方式是示教再现的，子锐机器人，即首先由操作者教机器人如何去做，机器人就记住这个过程，可以根据需要重复这个动作。所以工业机器人在示教和示教检查后，都有示教再现阶段。示教再现是将示教给机器人的程序内容重放出来。在示教再现阶段，机器人都是高速运转，所以进入示教再现模式前，应该严格遵守一切安全预防措施，比如确认急停开关正常工作、机器人没有干涉、确保机器人处于HOME(原点)位置等。

根据工业机器人自身特点，示教和示教检查后，就进入示教再现阶段进行自动作业。基于PMAC本身的运动语言格式，机器人在启用PMAC时，必然要涉及到机器人语言的识别及解释等问题。针对这些问题，机器人示教再现的关键问题集中在如何将示教后生成的(．prl)格式的机器码，通过自编的解释器解释后转换为PMAC能识别的(．pmc)格式的机器人语言，然后下载到PMAC程序缓冲区内部执行从而控制机器人进行自动作业。可以看出，示教再现模块是通过解释器模块与PMAC发生联系的。1是示教再现的用例。

1示教再现用例

从示教再现的用例可以看出，在示教再现研究中，经过示教检查后，程序都符合机器人的工作要求，所以只需要一些参数设置，然后就可以进行自动作业。相对于示教检查，示教再现模块主要实现的是如何试运行，以及工作中模块的调用、工作的暂停和暂停后的重启动等问题。示教再现模块会跟以下模块发生联系：

(1)调度模块：调度模块调出示教再现模式，允许机器人进行正常的操作。

(2)示教盒模块：示教盒发出控制指令，示教再现模块接受控制指令，按指令决定执行下一步的操作。

(3)示教编程模块：向示教再现模块的提供(．prl)格式的机器人语言，发送一些在线修改的参数。

(4)解释模块：示教再现中，需向解释模块送(．prl)格式的机器人语言，让其解释成PMAC识别的机器人语言，并下载到PMAC执行。同时，解释器解释完一步(．prl)格式语言时，会返回一个解释完的指令给示教再现模块。

示教再现用户流程如2所示。.

2示教再现用户流程

示教再现的研究内容包括下面几个方面：

(1)控制指令的判断问题。

(2)示教再现和解释器之间的调用问题，以及如何下载到PMAC的问题。

(3)示教再现的试操作。

(4)在线速度修改的问题。

(5)示教再现过程中的暂停和重启动的问题。

1基于PMAC的机器人示教再现的具体实现

六自由度机器人研制的过程中，实现控制系统的模块化，其模块包括自检和系统设置模块、轨迹规划模块、示教编程模块、示教检查模块、示教再现模块、解释模块、状态监控模块、故障诊断与处理模块和任务调度模块等几个模块。模块化后便于软件开发的分工合作，提高软件开发速度，进而提高整个系统的研制速度。示教再现时，控制器面板上RUN／HOLD(运转／保持)、TEACH／REPEAT(示教／再现)、控制电源、再现运转条件等必须进行有关设定。

PMAC具有自己的运动语言程序，有机床语言G代码和(．pmc)格式的机器人语言。在研制六自由度机器人中采用了(．pmc)格式的机器人语言。机器人的示教再现研究路线是：示教和示教检查后生成一个完整(．prl)格式的机器码组成的机器人作业文件集，每一行代码代表直线插补、圆弧插补或条件设置。示教编程模块读取整个(．prl)格式的文件集，从第一行开始把一行行代码送往示教再现模块，由示教再现模块进行简单分析和修改后送往解释器进行解释，直到最后一行代码工作完后跳出循环。解释器解释的同时由插补模块在主机上进行直线插补和圆弧插补，并且解释后的(．pmc)格式的机器人语言送往PMAC程序缓冲区执行进而控制机构运动，生成机器人末端轨迹。

考虑到机器人的通用性及机器人工作连贯性，必须事先设定运转／保持拨到运转、选择示教再现程序、设置示教再现速度、开示教锁定等条件。基于IPC+PMAC的六自由度机器人示教再现时，考虑到机器人工作时的安全性，必须先进行安全检查方面的准备工作。

示教再现时，机器码(．prl)格式需通过示教编程模块送给时间检查模块检查后，提供的示教再现进行再现作业。示教再现研究中，再现模块把(．prl)格式机器人语言调用给解释器，解释成(．pmc)格式机器人语言，然后下载到PMAC中运行，控制机器人运动。在该过程中，需要考虑的因素相对于示教检查模块少一些，只要考虑如何启动示教再现模块、外围设备IO的判断、控制指令的判断、示教再现速度参数的修改以及工作中的暂停和重启动等功能。示教再现的程序流程有以下几步：

(1)调度模块的调用。如3，在主机上负责对各个任务程序进行总调度，并调用相应的程序模块来响应用户的操作。工作模块的调用必须要经过调度模块，因此，在流程设计过程中，应该考虑怎样给调度模块留有接口，以便调度模块调用问题。调度模块启动示教再现模块，这个选择权决定于示教盒发来的控制指令，如果示教盒发来是示教再现的控制指令，则启动了示教再现模块。

3示教再现的调度

(2)控制指令的判断。如4，示教盒控制指令的判断主要有‘运转／保持’开关的判断、外围设备IO开启的判断、示教再现准备好的判断等，示教锁定开关默认是开的。

4示教再现的控制指令判断

(3)程序的调用。如5，需要示教编程模块送来一行(．prl)格式的机器人语言，经过修改一些参数后，送给解释器解释成(．pmc)格式的机器人语言。在该过程中，示教再现和解释器之间有可能相互调用。

5示教再现的程序调用

(4)一些参数的修改。如6，主要是接收从示教盒模块传来的速度参数，在一行(．prl)格式程序中寻找速度参数并用自定义的方法进行速度修改，把(．prl)格式的机器人语言送给解释器进行解释。

6示教再现的参数修改

(5)示教再现暂停的处理。示教再现过程中，如需在程序的执行过程中暂停，示教盒运转／保持开关拨到保持即可暂停，暂停后的程序要重新启动只需要将运转／保持开关拨到运行。或者可用PMAC卡自带的在线指令进行暂停和重启动。示教再现的暂停处理如7所示。

7示教再现的暂停

(6)程序下载到PMAC运行。经过解释器解释成(．pmc)格式机器人语言后，直接下载到PMAC运行。解释器解释的同时由插补模块在主机上进行直线插补和圆弧插补，并且解释后的(．pmc)格式的机器人语言送往PMAC程序缓冲区执行进而控制机构运动，生成机器人末端的轨迹。

2机器人示教再现的软件编程