[发明专利]双系统组件式的工业机器人控制器

说明书

技术领域

    本发明涉及一种工业机器人控制器，具体说是一种双系统组件式的工业机器人控制器。

背景技术：

机器人控制器在发展过程中按照机器人控制算法的处理方式来看,可分为单CPU 结构、 集中控制方式；二级CPU 结构、 主从式控制方式和多CPU分布式控制方式等。前两种结构出现在计算机技术发展的早期，采用微处理器芯片实现，CPU运算能力不够强，第三种结构多采用pc机+DSP板卡的形式，分别实现上位机程序和运动控制程序，如PMAC卡或Trio板卡。

这些方案存在一些相似的问题，结构普遍比较复杂，编程比较困难，而且系统运算能力较差，难以实现比如机器人动力学控制这样的复杂运算，软件与硬件联系比较紧密，配线过多，对系统进行调试及维修比较困难，导致系统的可靠性较差。而且当需要控制的节点不断增加时，控制变得异常复杂。如果实现更多轴的联动控制，则需要在整个结构上做大的调整，造成成本的增加。

目前最新的开放式的架构如专利CN1424649A“开放式结构机器人控制器”等，虽然也在PC机上利用实时系统开发了开放式的控制器，但是这些控制器基本上都是具有层次性的架构，每个层次所实现的功能是确定的，在增加新功能时往往需要对系统的框架进行修改，工作量非常大。

发明内容

本发明所要解决的技术问题，在于克服现有技术存在的缺陷，提出了一种双系统组件式的工业机器人控制器。采用“组件式”的结构，利用路由管理器和软总线实现组件式互联的基础，形成开放式构架。

    本发明双系统组件式的工业机器人控制器，包括：标准操作系统、实时操作系统、路由管理模块、软总线、驱动管理模块、运动控制模块、PLC模块（可编程控制器模块）、IO模块、示教盒接口模块和协议栈模块；其特征是：

所述标准操作系统和实时操作系统是所有组件模块运行的基础平台，示教盒接口模块、协议栈模块以及IO 模块运行在标准操作系统下，PLC模块、运动控制模块、驱动管理模块和路由管理模块运行在实时操作系统下；

软总线是一种自定义的Ethernet协议，通过组件模块的网络地址和功能地址，来向对应的组件功能发起请求及通讯；路由管理模块和软总线一起，将其他实时和非实时运行的模块连接起来；

路由管理模块用于对不同功能模块之间的访问进行路由选择及访问控制仲裁，并且对系统中的公用数据资源进行维护；各个功能模块（即：驱动管理模块、运动控制模块、PLC模块、IO模块、示教盒接口模块和协议栈模块）都有一个符合软总线协议规则的接口，当模块之间需要交互时，会通过该接口，将信息传递到软总线上，最后到达路由管理模块；路由管理模块对这些请求或回复进行解析，经过仲裁判断后，对对应的数据区进行操作，并对相关的模块进行指示或回复；

驱动管理模块（总线管理模块）对现场总线进行管理，驱动管理模块的下层为各种现场总线板卡或协议栈的驱动程序；驱动管理模块对各种现场总线板卡或协议栈的驱动程序进行抽象，在内部开辟一块内存区域，用于将这些总线抽象出来的数据进行映射；当其他功能模块需要访问现场总线所连接的设备时，驱动管理模块会为该访问提供一个相同的抽象接口，并在内部将该访问传递到正确的驱动程序上去；

运动控制模块对机器人进行运动规划及控制；该功能模块周期性运行，每个周期读取机器人各轴的当前信息，根据相应的算法进行运算后，将新的给定数据更新；这些数据由路由管理模块负责维护，最终传递到驱动管理模块上，并经过驱动程序发送到对应的硬件上；

IO模块和运动控制模块运行在同一级别，主要维护系统的IO信息，对上层程序提供常见的系统中已有的IO信号的访问；上层程序访问IO时，经过IO模块传递到路由管理模块上；路由管理模块将该信息转给驱动管理模块，最终经过驱动程序发送到对应的硬件上；

示教盒接口模块、协议栈模块和PLC模块处于同一级，为IO模块和运动控制模块的上层程序； PLC模块运行在实时系统下，示教盒接口模块、协议栈模块运行在非实时系统中。

本发明双系统组件式的工业机器人控制器，采用组件式结构，使得控制器为开放式构架，用户可以自行开发功能模块组件，并按照规则添加到系统中。而且控制器开放式的接口使得控制器可以连接的硬件不受限制。

附图说明

图1是本发明双系统组件式的工业机器人控制器结构示意框图。

具体实施方式

下面结合附图和实施例，对本发明做进一步详细说明。